12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008300930103011301230133014301530163017301830193020302130223023302430253026302730283029303030313032303330343035303630373038303930403041304230433044304530463047304830493050305130523053305430553056305730583059306030613062306330643065306630673068 |
- /*
- *
- * Realtek Bluetooth USB driver
- *
- *
- * 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
- *
- */
- #include <linux/kernel.h>
- #include <linux/module.h>
- #include <linux/init.h>
- #include <linux/slab.h>
- #include <linux/types.h>
- #include <linux/sched.h>
- #include <linux/errno.h>
- #include <linux/skbuff.h>
- #include <linux/dcache.h>
- #include <linux/version.h>
- #include <net/sock.h>
- #include <net/bluetooth/bluetooth.h>
- #include <net/bluetooth/hci_core.h>
- #include <net/bluetooth/l2cap.h>
- #include "rtk_coex.h"
- /* Software coex message can be sent to and receive from WiFi driver by
- * UDP socket or exported symbol */
- /* #define RTK_COEX_OVER_SYMBOL */
- #if BTRTL_HCI_IF == BTRTL_HCIUSB
- #include <linux/usb.h>
- #include "rtk_bt.h"
- #undef RTKBT_DBG
- #undef RTKBT_INFO
- #undef RTKBT_WARN
- #undef RTKBT_ERR
- #elif BTRTL_HCI_IF == BTRTL_HCIUART
- /* #define HCI_VERSION_CODE KERNEL_VERSION(3, 14, 41) */
- #define HCI_VERSION_CODE LINUX_VERSION_CODE
- #else
- #error "Please set type of HCI interface"
- #endif
- #define RTK_VERSION "1.2"
- #define RTKBT_DBG(fmt, arg...) printk(KERN_INFO "rtk_btcoex: " fmt "\n" , ## arg)
- #define RTKBT_INFO(fmt, arg...) printk(KERN_INFO "rtk_btcoex: " fmt "\n" , ## arg)
- #define RTKBT_WARN(fmt, arg...) printk(KERN_WARNING "rtk_btcoex: " fmt "\n", ## arg)
- #define RTKBT_ERR(fmt, arg...) printk(KERN_WARNING "rtk_btcoex: " fmt "\n", ## arg)
- static struct rtl_coex_struct btrtl_coex;
- #ifdef RTB_SOFTWARE_MAILBOX
- #ifdef RTK_COEX_OVER_SYMBOL
- static struct sk_buff_head rtw_q;
- static struct workqueue_struct *rtw_wq;
- static struct work_struct rtw_work;
- static u8 rtw_coex_on;
- #endif
- #endif
- #define is_profile_connected(profile) ((btrtl_coex.profile_bitmap & BIT(profile)) > 0)
- #define is_profile_busy(profile) ((btrtl_coex.profile_status & BIT(profile)) > 0)
- #ifdef RTB_SOFTWARE_MAILBOX
- static void rtk_handle_event_from_wifi(uint8_t * msg);
- #endif
- static int rtl_alloc_buff(struct rtl_coex_struct *coex)
- {
- struct rtl_hci_ev *ev;
- struct rtl_l2_buff *l2;
- int i;
- int order;
- unsigned long addr;
- unsigned long addr2;
- int ev_size;
- int l2_size;
- int n;
- spin_lock_init(&coex->buff_lock);
- INIT_LIST_HEAD(&coex->ev_used_list);
- INIT_LIST_HEAD(&coex->ev_free_list);
- INIT_LIST_HEAD(&coex->l2_used_list);
- INIT_LIST_HEAD(&coex->l2_free_list);
- n = NUM_RTL_HCI_EV * sizeof(struct rtl_hci_ev);
- ev_size = ALIGN(n, sizeof(unsigned long));
- n = L2_MAX_PKTS * sizeof(struct rtl_l2_buff);
- l2_size = ALIGN(n, sizeof(unsigned long));
- RTKBT_DBG("alloc buffers %d, %d for ev and l2", ev_size, l2_size);
- order = get_order(ev_size + l2_size);
- addr = __get_free_pages(GFP_KERNEL, order);
- if (!addr) {
- RTKBT_ERR("failed to alloc buffers for ev and l2.");
- return -ENOMEM;
- }
- memset((void *)addr, 0, ev_size + l2_size);
- coex->pages_addr = addr;
- coex->buff_size = ev_size + l2_size;
- ev = (struct rtl_hci_ev *)addr;
- for (i = 0; i < NUM_RTL_HCI_EV; i++) {
- list_add_tail(&ev->list, &coex->ev_free_list);
- ev++;
- }
- addr2 = addr + ev_size;
- l2 = (struct rtl_l2_buff *)addr2;
- for (i = 0; i < L2_MAX_PKTS; i++) {
- list_add_tail(&l2->list, &coex->l2_free_list);
- l2++;
- }
- return 0;
- }
- static void rtl_free_buff(struct rtl_coex_struct *coex)
- {
- struct rtl_hci_ev *ev;
- struct rtl_l2_buff *l2;
- unsigned long flags;
- spin_lock_irqsave(&coex->buff_lock, flags);
- while (!list_empty(&coex->ev_used_list)) {
- ev = list_entry(coex->ev_used_list.next, struct rtl_hci_ev,
- list);
- list_del(&ev->list);
- }
- while (!list_empty(&coex->ev_free_list)) {
- ev = list_entry(coex->ev_free_list.next, struct rtl_hci_ev,
- list);
- list_del(&ev->list);
- }
- while (!list_empty(&coex->l2_used_list)) {
- l2 = list_entry(coex->l2_used_list.next, struct rtl_l2_buff,
- list);
- list_del(&l2->list);
- }
- while (!list_empty(&coex->l2_free_list)) {
- l2 = list_entry(coex->l2_free_list.next, struct rtl_l2_buff,
- list);
- list_del(&l2->list);
- }
- spin_unlock_irqrestore(&coex->buff_lock, flags);
- if (coex->buff_size > 0) {
- free_pages(coex->pages_addr, get_order(coex->buff_size));
- coex->pages_addr = 0;
- coex->buff_size = 0;
- }
- }
- static struct rtl_hci_ev *rtl_ev_node_get(struct rtl_coex_struct *coex)
- {
- struct rtl_hci_ev *ev;
- unsigned long flags;
- if (!coex->buff_size)
- return NULL;
- spin_lock_irqsave(&coex->buff_lock, flags);
- if (!list_empty(&coex->ev_free_list)) {
- ev = list_entry(coex->ev_free_list.next, struct rtl_hci_ev,
- list);
- list_del(&ev->list);
- } else
- ev = NULL;
- spin_unlock_irqrestore(&coex->buff_lock, flags);
- return ev;
- }
- static int rtl_ev_node_to_used(struct rtl_coex_struct *coex,
- struct rtl_hci_ev *ev)
- {
- unsigned long flags;
- spin_lock_irqsave(&coex->buff_lock, flags);
- list_add_tail(&ev->list, &coex->ev_used_list);
- spin_unlock_irqrestore(&coex->buff_lock, flags);
- return 0;
- }
- static struct rtl_l2_buff *rtl_l2_node_get(struct rtl_coex_struct *coex)
- {
- struct rtl_l2_buff *l2;
- unsigned long flags;
- if (!coex->buff_size)
- return NULL;
- spin_lock_irqsave(&coex->buff_lock, flags);
- if(!list_empty(&coex->l2_free_list)) {
- l2 = list_entry(coex->l2_free_list.next, struct rtl_l2_buff,
- list);
- list_del(&l2->list);
- } else
- l2 = NULL;
- spin_unlock_irqrestore(&coex->buff_lock, flags);
- return l2;
- }
- static int rtl_l2_node_to_used(struct rtl_coex_struct *coex,
- struct rtl_l2_buff *l2)
- {
- unsigned long flags;
- spin_lock_irqsave(&coex->buff_lock, flags);
- list_add_tail(&l2->list, &coex->l2_used_list);
- spin_unlock_irqrestore(&coex->buff_lock, flags);
- return 0;
- }
- static int8_t psm_to_profile_index(uint16_t psm)
- {
- switch (psm) {
- case PSM_AVCTP:
- case PSM_SDP:
- return -1; //ignore
- case PSM_HID:
- case PSM_HID_INT:
- return profile_hid;
- case PSM_AVDTP:
- return profile_a2dp;
- case PSM_PAN:
- case PSM_OPP:
- case PSM_FTP:
- case PSM_BIP:
- case PSM_RFCOMM:
- return profile_pan;
- default:
- return profile_pan;
- }
- }
- static rtk_prof_info *find_by_psm(u16 psm)
- {
- struct list_head *head = &btrtl_coex.profile_list;
- struct list_head *iter = NULL;
- struct list_head *temp = NULL;
- rtk_prof_info *desc = NULL;
- list_for_each_safe(iter, temp, head) {
- desc = list_entry(iter, rtk_prof_info, list);
- if (desc->psm == psm)
- return desc;
- }
- return NULL;
- }
- static void rtk_check_setup_timer(int8_t profile_index)
- {
- if (profile_index == profile_a2dp) {
- btrtl_coex.a2dp_packet_count = 0;
- btrtl_coex.a2dp_count_timer.expires =
- jiffies + msecs_to_jiffies(1000);
- mod_timer(&btrtl_coex.a2dp_count_timer,
- btrtl_coex.a2dp_count_timer.expires);
- }
- if (profile_index == profile_pan) {
- btrtl_coex.pan_packet_count = 0;
- btrtl_coex.pan_count_timer.expires =
- jiffies + msecs_to_jiffies(1000);
- mod_timer(&btrtl_coex.pan_count_timer,
- btrtl_coex.pan_count_timer.expires);
- }
- /* hogp & voice share one timer now */
- if ((profile_index == profile_hogp) || (profile_index == profile_voice)) {
- if ((0 == btrtl_coex.profile_refcount[profile_hogp])
- && (0 == btrtl_coex.profile_refcount[profile_voice])) {
- btrtl_coex.hogp_packet_count = 0;
- btrtl_coex.voice_packet_count = 0;
- btrtl_coex.hogp_count_timer.expires =
- jiffies + msecs_to_jiffies(1000);
- mod_timer(&btrtl_coex.hogp_count_timer,
- btrtl_coex.hogp_count_timer.expires);
- }
- }
- }
- static void rtk_check_del_timer(int8_t profile_index)
- {
- if (profile_a2dp == profile_index) {
- btrtl_coex.a2dp_packet_count = 0;
- del_timer_sync(&btrtl_coex.a2dp_count_timer);
- }
- if (profile_pan == profile_index) {
- btrtl_coex.pan_packet_count = 0;
- del_timer_sync(&btrtl_coex.pan_count_timer);
- }
- if (profile_hogp == profile_index) {
- btrtl_coex.hogp_packet_count = 0;
- if (btrtl_coex.profile_refcount[profile_voice] == 0) {
- del_timer_sync(&btrtl_coex.hogp_count_timer);
- }
- }
- if (profile_voice == profile_index) {
- btrtl_coex.voice_packet_count = 0;
- if (btrtl_coex.profile_refcount[profile_hogp] == 0) {
- del_timer_sync(&btrtl_coex.hogp_count_timer);
- }
- }
- }
- static rtk_conn_prof *find_connection_by_handle(struct rtl_coex_struct * coex,
- uint16_t handle)
- {
- struct list_head *head = &coex->conn_hash;
- struct list_head *iter = NULL, *temp = NULL;
- rtk_conn_prof *desc = NULL;
- list_for_each_safe(iter, temp, head) {
- desc = list_entry(iter, rtk_conn_prof, list);
- if ((handle & 0xEFF) == desc->handle) {
- return desc;
- }
- }
- return NULL;
- }
- static rtk_conn_prof *allocate_connection_by_handle(uint16_t handle)
- {
- rtk_conn_prof *phci_conn = NULL;
- phci_conn = kmalloc(sizeof(rtk_conn_prof), GFP_ATOMIC);
- if (phci_conn)
- phci_conn->handle = handle;
- return phci_conn;
- }
- static void init_connection_hash(struct rtl_coex_struct * coex)
- {
- struct list_head *head = &coex->conn_hash;
- INIT_LIST_HEAD(head);
- }
- static void add_connection_to_hash(struct rtl_coex_struct * coex,
- rtk_conn_prof * desc)
- {
- struct list_head *head = &coex->conn_hash;
- list_add_tail(&desc->list, head);
- }
- static void delete_connection_from_hash(rtk_conn_prof * desc)
- {
- if (desc) {
- list_del(&desc->list);
- kfree(desc);
- }
- }
- static void flush_connection_hash(struct rtl_coex_struct * coex)
- {
- struct list_head *head = &coex->conn_hash;
- struct list_head *iter = NULL, *temp = NULL;
- rtk_conn_prof *desc = NULL;
- list_for_each_safe(iter, temp, head) {
- desc = list_entry(iter, rtk_conn_prof, list);
- if (desc) {
- list_del(&desc->list);
- kfree(desc);
- }
- }
- //INIT_LIST_HEAD(head);
- }
- static void init_profile_hash(struct rtl_coex_struct * coex)
- {
- struct list_head *head = &coex->profile_list;
- INIT_LIST_HEAD(head);
- }
- static uint8_t list_allocate_add(uint16_t handle, uint16_t psm,
- int8_t profile_index, uint16_t dcid,
- uint16_t scid)
- {
- rtk_prof_info *pprof_info = NULL;
- if (profile_index < 0) {
- RTKBT_ERR("PSM 0x%x do not need parse", psm);
- return FALSE;
- }
- pprof_info = kmalloc(sizeof(rtk_prof_info), GFP_ATOMIC);
- if (NULL == pprof_info) {
- RTKBT_ERR("list_allocate_add: allocate error");
- return FALSE;
- }
- /* Check if it is the second l2cap connection for a2dp
- * a2dp signal channel will be created first than media channel.
- */
- if (psm == PSM_AVDTP) {
- rtk_prof_info *pinfo = find_by_psm(psm);
- if (!pinfo) {
- pprof_info->flags = A2DP_SIGNAL;
- RTKBT_INFO("%s: Add a2dp signal channel", __func__);
- } else {
- pprof_info->flags = A2DP_MEDIA;
- RTKBT_INFO("%s: Add a2dp media channel", __func__);
- }
- }
- pprof_info->handle = handle;
- pprof_info->psm = psm;
- pprof_info->scid = scid;
- pprof_info->dcid = dcid;
- pprof_info->profile_index = profile_index;
- list_add_tail(&(pprof_info->list), &(btrtl_coex.profile_list));
- return TRUE;
- }
- static void delete_profile_from_hash(rtk_prof_info * desc)
- {
- RTKBT_DBG("Delete profile: hndl 0x%04x, psm 0x%04x, dcid 0x%04x, "
- "scid 0x%04x", desc->handle, desc->psm, desc->dcid,
- desc->scid);
- if (desc) {
- list_del(&desc->list);
- kfree(desc);
- desc = NULL;
- }
- }
- static void flush_profile_hash(struct rtl_coex_struct * coex)
- {
- struct list_head *head = &coex->profile_list;
- struct list_head *iter = NULL, *temp = NULL;
- rtk_prof_info *desc = NULL;
- spin_lock(&btrtl_coex.spin_lock_profile);
- list_for_each_safe(iter, temp, head) {
- desc = list_entry(iter, rtk_prof_info, list);
- delete_profile_from_hash(desc);
- }
- //INIT_LIST_HEAD(head);
- spin_unlock(&btrtl_coex.spin_lock_profile);
- }
- static rtk_prof_info *find_profile_by_handle_scid(struct rtl_coex_struct *
- coex, uint16_t handle,
- uint16_t scid)
- {
- struct list_head *head = &coex->profile_list;
- struct list_head *iter = NULL, *temp = NULL;
- rtk_prof_info *desc = NULL;
- list_for_each_safe(iter, temp, head) {
- desc = list_entry(iter, rtk_prof_info, list);
- if (((handle & 0xFFF) == desc->handle) && (scid == desc->scid)) {
- return desc;
- }
- }
- return NULL;
- }
- static rtk_prof_info *find_profile_by_handle_dcid(struct rtl_coex_struct *
- coex, uint16_t handle,
- uint16_t dcid)
- {
- struct list_head *head = &coex->profile_list;
- struct list_head *iter = NULL, *temp = NULL;
- rtk_prof_info *desc = NULL;
- list_for_each_safe(iter, temp, head) {
- desc = list_entry(iter, rtk_prof_info, list);
- if (((handle & 0xFFF) == desc->handle) && (dcid == desc->dcid)) {
- return desc;
- }
- }
- return NULL;
- }
- static rtk_prof_info *find_profile_by_handle_dcid_scid(struct rtl_coex_struct
- * coex, uint16_t handle,
- uint16_t dcid,
- uint16_t scid)
- {
- struct list_head *head = &coex->profile_list;
- struct list_head *iter = NULL, *temp = NULL;
- rtk_prof_info *desc = NULL;
- list_for_each_safe(iter, temp, head) {
- desc = list_entry(iter, rtk_prof_info, list);
- if (((handle & 0xFFF) == desc->handle) && (dcid == desc->dcid)
- && (scid == desc->scid)) {
- return desc;
- }
- }
- return NULL;
- }
- static void rtk_vendor_cmd_to_fw(uint16_t opcode, uint8_t parameter_len,
- uint8_t * parameter)
- {
- int len = HCI_CMD_PREAMBLE_SIZE + parameter_len;
- uint8_t *p;
- struct sk_buff *skb;
- struct hci_dev *hdev = btrtl_coex.hdev;
- if (!hdev) {
- RTKBT_ERR("No HCI device");
- return;
- } else if (!test_bit(HCI_UP, &hdev->flags)) {
- RTKBT_WARN("HCI device is down");
- return;
- }
- skb = bt_skb_alloc(len, GFP_ATOMIC);
- if (!skb) {
- RTKBT_DBG("there is no room for cmd 0x%x", opcode);
- return;
- }
- p = (uint8_t *) skb_put(skb, HCI_CMD_PREAMBLE_SIZE);
- UINT16_TO_STREAM(p, opcode);
- *p++ = parameter_len;
- if (parameter_len)
- memcpy(skb_put(skb, parameter_len), parameter, parameter_len);
- bt_cb(skb)->pkt_type = HCI_COMMAND_PKT;
- #if HCI_VERSION_CODE >= KERNEL_VERSION(3, 18, 0)
- #if HCI_VERSION_CODE < KERNEL_VERSION(4, 4, 0)
- bt_cb(skb)->opcode = opcode;
- #else
- bt_cb(skb)->hci.opcode = opcode;
- #endif
- #endif
- /* Stand-alone HCI commands must be flagged as
- * single-command requests.
- */
- #if HCI_VERSION_CODE >= KERNEL_VERSION(3, 10, 0)
- #if HCI_VERSION_CODE < KERNEL_VERSION(4, 4, 0)
- bt_cb(skb)->req.start = true;
- #else
- #if HCI_VERSION_CODE < KERNEL_VERSION(4, 5, 0)
- bt_cb(skb)->hci.req_start = true;
- #else
- bt_cb(skb)->hci.req_flags |= HCI_REQ_START;
- #endif
- #endif /* 4.4.0 */
- #endif /* 3.10.0 */
- RTKBT_DBG("%s: opcode 0x%x", __func__, opcode);
- /* It is harmless if set skb->dev twice. The dev will be used in
- * btusb_send_frame() after or equal to kernel/hci 3.13.0,
- * the hdev will not come from skb->dev. */
- #if HCI_VERSION_CODE < KERNEL_VERSION(3, 13, 0)
- skb->dev = (void *)btrtl_coex.hdev;
- #endif
- /* Put the skb to the global hdev->cmd_q */
- skb_queue_tail(&hdev->cmd_q, skb);
- #if HCI_VERSION_CODE < KERNEL_VERSION(3, 3, 0)
- tasklet_schedule(&hdev->cmd_task);
- #else
- queue_work(hdev->workqueue, &hdev->cmd_work);
- #endif
- return;
- }
- static void rtk_notify_profileinfo_to_fw(void)
- {
- struct list_head *head = NULL;
- struct list_head *iter = NULL;
- struct list_head *temp = NULL;
- rtk_conn_prof *hci_conn = NULL;
- uint8_t handle_number = 0;
- uint32_t buffer_size = 0;
- uint8_t *p_buf = NULL;
- uint8_t *p = NULL;
- head = &btrtl_coex.conn_hash;
- list_for_each_safe(iter, temp, head) {
- hci_conn = list_entry(iter, rtk_conn_prof, list);
- if (hci_conn && hci_conn->profile_bitmap)
- handle_number++;
- }
- buffer_size = 1 + handle_number * 3 + 1;
- p_buf = kmalloc(buffer_size, GFP_ATOMIC);
- if (NULL == p_buf) {
- RTKBT_ERR("%s: alloc error", __func__);
- return;
- }
- p = p_buf;
- RTKBT_DBG("%s: BufferSize %u", __func__, buffer_size);
- *p++ = handle_number;
- RTKBT_DBG("%s: NumberOfHandles %u", __func__, handle_number);
- head = &btrtl_coex.conn_hash;
- list_for_each(iter, head) {
- hci_conn = list_entry(iter, rtk_conn_prof, list);
- if (hci_conn && hci_conn->profile_bitmap) {
- UINT16_TO_STREAM(p, hci_conn->handle);
- RTKBT_DBG("%s: handle 0x%04x", __func__,
- hci_conn->handle);
- *p++ = hci_conn->profile_bitmap;
- RTKBT_DBG("%s: profile_bitmap 0x%02x", __func__,
- hci_conn->profile_bitmap);
- handle_number--;
- }
- if (0 == handle_number)
- break;
- }
- *p++ = btrtl_coex.profile_status;
- RTKBT_DBG("%s: profile_status 0x%02x", __func__,
- btrtl_coex.profile_status);
- rtk_vendor_cmd_to_fw(HCI_VENDOR_SET_PROFILE_REPORT_COMMAND, buffer_size,
- p_buf);
- kfree(p_buf);
- return;
- }
- static void update_profile_state(uint8_t profile_index, uint8_t is_busy)
- {
- uint8_t need_update = FALSE;
- if ((btrtl_coex.profile_bitmap & BIT(profile_index)) == 0) {
- RTKBT_ERR("%s: : ERROR!!! profile(Index: %x) does not exist",
- __func__, profile_index);
- return;
- }
- if (is_busy) {
- if ((btrtl_coex.profile_status & BIT(profile_index)) == 0) {
- need_update = TRUE;
- btrtl_coex.profile_status |= BIT(profile_index);
- }
- } else {
- if ((btrtl_coex.profile_status & BIT(profile_index)) > 0) {
- need_update = TRUE;
- btrtl_coex.profile_status &= ~(BIT(profile_index));
- }
- }
- if (need_update) {
- RTKBT_DBG("%s: btrtl_coex.profie_bitmap = %x",
- __func__, btrtl_coex.profile_bitmap);
- RTKBT_DBG("%s: btrtl_coex.profile_status = %x",
- __func__, btrtl_coex.profile_status);
- rtk_notify_profileinfo_to_fw();
- }
- }
- static void update_profile_connection(rtk_conn_prof * phci_conn,
- int8_t profile_index, uint8_t is_add)
- {
- uint8_t need_update = FALSE;
- uint8_t kk;
- RTKBT_DBG("%s: is_add %d, profile_index %x", __func__,
- is_add, profile_index);
- if (profile_index < 0)
- return;
- if (is_add) {
- if (btrtl_coex.profile_refcount[profile_index] == 0) {
- need_update = TRUE;
- btrtl_coex.profile_bitmap |= BIT(profile_index);
- /* SCO is always busy */
- if (profile_index == profile_sco)
- btrtl_coex.profile_status |=
- BIT(profile_index);
- rtk_check_setup_timer(profile_index);
- }
- btrtl_coex.profile_refcount[profile_index]++;
- if (0 == phci_conn->profile_refcount[profile_index]) {
- need_update = TRUE;
- phci_conn->profile_bitmap |= BIT(profile_index);
- }
- phci_conn->profile_refcount[profile_index]++;
- } else {
- if (!btrtl_coex.profile_refcount[profile_index]) {
- RTKBT_WARN("profile %u refcount is already zero",
- profile_index);
- return;
- }
- btrtl_coex.profile_refcount[profile_index]--;
- RTKBT_DBG("%s: btrtl_coex.profile_refcount[%x] = %x",
- __func__, profile_index,
- btrtl_coex.profile_refcount[profile_index]);
- if (btrtl_coex.profile_refcount[profile_index] == 0) {
- need_update = TRUE;
- btrtl_coex.profile_bitmap &= ~(BIT(profile_index));
- /* if profile does not exist, status is meaningless */
- btrtl_coex.profile_status &= ~(BIT(profile_index));
- rtk_check_del_timer(profile_index);
- }
- phci_conn->profile_refcount[profile_index]--;
- if (0 == phci_conn->profile_refcount[profile_index]) {
- need_update = TRUE;
- phci_conn->profile_bitmap &= ~(BIT(profile_index));
- /* clear profile_hid_interval if need */
- if ((profile_hid == profile_index)
- && (phci_conn->
- profile_bitmap & (BIT(profile_hid_interval)))) {
- phci_conn->profile_bitmap &=
- ~(BIT(profile_hid_interval));
- btrtl_coex.
- profile_refcount[profile_hid_interval]--;
- }
- }
- }
- RTKBT_DBG("%s: btrtl_coex.profile_bitmap 0x%02x", __func__,
- btrtl_coex.profile_bitmap);
- for (kk = 0; kk < 8; kk++)
- RTKBT_DBG("%s: btrtl_coex.profile_refcount[%d] = %d",
- __func__, kk,
- btrtl_coex.profile_refcount[kk]);
- if (need_update)
- rtk_notify_profileinfo_to_fw();
- }
- static void update_hid_active_state(uint16_t handle, uint16_t interval)
- {
- uint8_t need_update = 0;
- rtk_conn_prof *phci_conn =
- find_connection_by_handle(&btrtl_coex, handle);
- if (phci_conn == NULL)
- return;
- RTKBT_DBG("%s: handle 0x%04x, interval %u", __func__, handle, interval);
- if (((phci_conn->profile_bitmap) & (BIT(profile_hid))) == 0) {
- RTKBT_DBG("HID not connected, nothing to be down");
- return;
- }
- if (interval < 60) {
- if ((phci_conn->profile_bitmap & (BIT(profile_hid_interval))) ==
- 0) {
- need_update = 1;
- phci_conn->profile_bitmap |= BIT(profile_hid_interval);
- btrtl_coex.profile_refcount[profile_hid_interval]++;
- if (btrtl_coex.
- profile_refcount[profile_hid_interval] == 1)
- btrtl_coex.profile_status |=
- BIT(profile_hid);
- }
- } else {
- if ((phci_conn->profile_bitmap & (BIT(profile_hid_interval)))) {
- need_update = 1;
- phci_conn->profile_bitmap &=
- ~(BIT(profile_hid_interval));
- btrtl_coex.profile_refcount[profile_hid_interval]--;
- if (btrtl_coex.
- profile_refcount[profile_hid_interval] == 0)
- btrtl_coex.profile_status &=
- ~(BIT(profile_hid));
- }
- }
- if (need_update)
- rtk_notify_profileinfo_to_fw();
- }
- static uint8_t handle_l2cap_con_req(uint16_t handle, uint16_t psm,
- uint16_t scid, uint8_t direction)
- {
- uint8_t status = FALSE;
- rtk_prof_info *prof_info = NULL;
- int8_t profile_index = psm_to_profile_index(psm);
- if (profile_index < 0) {
- RTKBT_DBG("PSM(0x%04x) do not need parse", psm);
- return status;
- }
- spin_lock(&btrtl_coex.spin_lock_profile);
- if (direction) //1: out
- prof_info =
- find_profile_by_handle_scid(&btrtl_coex, handle, scid);
- else // 0:in
- prof_info =
- find_profile_by_handle_dcid(&btrtl_coex, handle, scid);
- if (prof_info) {
- RTKBT_DBG("%s: this profile is already exist!", __func__);
- spin_unlock(&btrtl_coex.spin_lock_profile);
- return status;
- }
- if (direction) //1: out
- status = list_allocate_add(handle, psm, profile_index, 0, scid);
- else // 0:in
- status = list_allocate_add(handle, psm, profile_index, scid, 0);
- spin_unlock(&btrtl_coex.spin_lock_profile);
- if (!status)
- RTKBT_ERR("%s: list_allocate_add failed!", __func__);
- return status;
- }
- static uint8_t handle_l2cap_con_rsp(uint16_t handle, uint16_t dcid,
- uint16_t scid, uint8_t direction,
- uint8_t result)
- {
- rtk_prof_info *prof_info = NULL;
- rtk_conn_prof *phci_conn = NULL;
- spin_lock(&btrtl_coex.spin_lock_profile);
- if (!direction) //0, in
- prof_info =
- find_profile_by_handle_scid(&btrtl_coex, handle, scid);
- else //1, out
- prof_info =
- find_profile_by_handle_dcid(&btrtl_coex, handle, scid);
- if (!prof_info) {
- //RTKBT_DBG("handle_l2cap_con_rsp: prof_info Not Find!!");
- spin_unlock(&btrtl_coex.spin_lock_profile);
- return FALSE;
- }
- if (!result) { //success
- RTKBT_DBG("l2cap connection success, update connection");
- if (!direction) //0, in
- prof_info->dcid = dcid;
- else //1, out
- prof_info->scid = dcid;
- phci_conn = find_connection_by_handle(&btrtl_coex, handle);
- if (phci_conn)
- update_profile_connection(phci_conn,
- prof_info->profile_index,
- TRUE);
- }
- spin_unlock(&btrtl_coex.spin_lock_profile);
- return TRUE;
- }
- static uint8_t handle_l2cap_discon_req(uint16_t handle, uint16_t dcid,
- uint16_t scid, uint8_t direction)
- {
- rtk_prof_info *prof_info = NULL;
- rtk_conn_prof *phci_conn = NULL;
- RTKBT_DBG("%s: handle 0x%04x, dcid 0x%04x, scid 0x%04x, dir %u",
- __func__, handle, dcid, scid, direction);
- spin_lock(&btrtl_coex.spin_lock_profile);
- if (!direction) //0: in
- prof_info =
- find_profile_by_handle_dcid_scid(&btrtl_coex, handle,
- scid, dcid);
- else //1: out
- prof_info =
- find_profile_by_handle_dcid_scid(&btrtl_coex, handle,
- dcid, scid);
- if (!prof_info) {
- //LogMsg("handle_l2cap_discon_req: prof_info Not Find!");
- spin_unlock(&btrtl_coex.spin_lock_profile);
- return 0;
- }
- phci_conn = find_connection_by_handle(&btrtl_coex, handle);
- if (!phci_conn) {
- spin_unlock(&btrtl_coex.spin_lock_profile);
- return 0;
- }
- update_profile_connection(phci_conn, prof_info->profile_index, FALSE);
- if (prof_info->profile_index == profile_a2dp &&
- (phci_conn->profile_bitmap & BIT(profile_sink)))
- update_profile_connection(phci_conn, profile_sink, FALSE);
- delete_profile_from_hash(prof_info);
- spin_unlock(&btrtl_coex.spin_lock_profile);
- return 1;
- }
- static const char sample_freqs[4][8] = {
- "16", "32", "44.1", "48"
- };
- static const uint8_t sbc_blocks[4] = { 4, 8, 12, 16 };
- static const char chan_modes[4][16] = {
- "MONO", "DUAL_CHANNEL", "STEREO", "JOINT_STEREO"
- };
- static const char alloc_methods[2][12] = {
- "LOUDNESS", "SNR"
- };
- static const uint8_t subbands[2] = { 4, 8 };
- void print_sbc_header(struct sbc_frame_hdr *hdr)
- {
- RTKBT_DBG("syncword: %02x", hdr->syncword);
- RTKBT_DBG("freq %skHz", sample_freqs[hdr->sampling_frequency]);
- RTKBT_DBG("blocks %u", sbc_blocks[hdr->blocks]);
- RTKBT_DBG("channel mode %s", chan_modes[hdr->channel_mode]);
- RTKBT_DBG("allocation method %s",
- alloc_methods[hdr->allocation_method]);
- RTKBT_DBG("subbands %u", subbands[hdr->subbands]);
- }
- static void packets_count(uint16_t handle, uint16_t scid, uint16_t length,
- uint8_t direction, u8 *user_data)
- {
- rtk_prof_info *prof_info = NULL;
- rtk_conn_prof *hci_conn =
- find_connection_by_handle(&btrtl_coex, handle);
- if (NULL == hci_conn)
- return;
- if (0 == hci_conn->type) {
- if (!direction) //0: in
- prof_info =
- find_profile_by_handle_scid(&btrtl_coex, handle,
- scid);
- else //1: out
- prof_info =
- find_profile_by_handle_dcid(&btrtl_coex, handle,
- scid);
- if (!prof_info) {
- //RTKBT_DBG("packets_count: prof_info Not Find!");
- return;
- }
- /* avdtp media data */
- if (prof_info->profile_index == profile_a2dp &&
- prof_info->flags == A2DP_MEDIA) {
- if (!is_profile_busy(profile_a2dp)) {
- struct sbc_frame_hdr *sbc_header;
- struct rtp_header *rtph;
- u8 bitpool;
- update_profile_state(profile_a2dp, TRUE);
- if (!direction) {
- if (!(hci_conn->profile_bitmap & BIT(profile_sink))) {
- btrtl_coex.profile_bitmap |= BIT(profile_sink);
- hci_conn->profile_bitmap |= BIT(profile_sink);
- update_profile_connection(hci_conn, profile_sink, 1);
- }
- update_profile_state(profile_sink, TRUE);
- }
- /* We assume it is SBC if the packet length
- * is bigger than 100 bytes
- */
- if (length > 100) {
- RTKBT_INFO("Length %u", length);
- rtph = (struct rtp_header *)user_data;
- RTKBT_DBG("rtp: v %u, cc %u, pt %u",
- rtph->v, rtph->cc, rtph->pt);
- /* move forward */
- user_data += sizeof(struct rtp_header) +
- rtph->cc * 4 + 1;
- /* point to the sbc frame header */
- sbc_header = (struct sbc_frame_hdr *)user_data;
- bitpool = sbc_header->bitpool;
- print_sbc_header(sbc_header);
- RTKBT_DBG("bitpool %u", bitpool);
- rtk_vendor_cmd_to_fw(HCI_VENDOR_SET_BITPOOL,
- 1, &bitpool);
- }
- }
- btrtl_coex.a2dp_packet_count++;
- }
- if (prof_info->profile_index == profile_pan)
- btrtl_coex.pan_packet_count++;
- }
- }
- #if LINUX_VERSION_CODE > KERNEL_VERSION(4, 14, 0)
- static void count_a2dp_packet_timeout(struct timer_list *unused)
- #else
- static void count_a2dp_packet_timeout(unsigned long data)
- #endif
- {
- if (btrtl_coex.a2dp_packet_count)
- RTKBT_DBG("%s: a2dp_packet_count %d", __func__,
- btrtl_coex.a2dp_packet_count);
- if (btrtl_coex.a2dp_packet_count == 0) {
- if (is_profile_busy(profile_a2dp)) {
- RTKBT_DBG("%s: a2dp busy->idle!", __func__);
- update_profile_state(profile_a2dp, FALSE);
- if (btrtl_coex.profile_bitmap & BIT(profile_sink))
- update_profile_state(profile_sink, FALSE);
- }
- }
- btrtl_coex.a2dp_packet_count = 0;
- mod_timer(&btrtl_coex.a2dp_count_timer,
- jiffies + msecs_to_jiffies(1000));
- }
- #if LINUX_VERSION_CODE > KERNEL_VERSION(4, 14, 0)
- static void count_pan_packet_timeout(struct timer_list *unused)
- #else
- static void count_pan_packet_timeout(unsigned long data)
- #endif
- {
- if (btrtl_coex.pan_packet_count)
- RTKBT_DBG("%s: pan_packet_count %d", __func__,
- btrtl_coex.pan_packet_count);
- if (btrtl_coex.pan_packet_count < PAN_PACKET_COUNT) {
- if (is_profile_busy(profile_pan)) {
- RTKBT_DBG("%s: pan busy->idle!", __func__);
- update_profile_state(profile_pan, FALSE);
- }
- } else {
- if (!is_profile_busy(profile_pan)) {
- RTKBT_DBG("timeout_handler: pan idle->busy!");
- update_profile_state(profile_pan, TRUE);
- }
- }
- btrtl_coex.pan_packet_count = 0;
- mod_timer(&btrtl_coex.pan_count_timer,
- jiffies + msecs_to_jiffies(1000));
- }
- #if LINUX_VERSION_CODE > KERNEL_VERSION(4, 14, 0)
- static void count_hogp_packet_timeout(struct timer_list *unused)
- #else
- static void count_hogp_packet_timeout(unsigned long data)
- #endif
- {
- if (btrtl_coex.hogp_packet_count)
- RTKBT_DBG("%s: hogp_packet_count %d", __func__,
- btrtl_coex.hogp_packet_count);
- if (btrtl_coex.hogp_packet_count == 0) {
- if (is_profile_busy(profile_hogp)) {
- RTKBT_DBG("%s: hogp busy->idle!", __func__);
- update_profile_state(profile_hogp, FALSE);
- }
- }
- btrtl_coex.hogp_packet_count = 0;
- if (btrtl_coex.voice_packet_count)
- RTKBT_DBG("%s: voice_packet_count %d", __func__,
- btrtl_coex.voice_packet_count);
- if (btrtl_coex.voice_packet_count == 0) {
- if (is_profile_busy(profile_voice)) {
- RTKBT_DBG("%s: voice busy->idle!", __func__);
- update_profile_state(profile_voice, FALSE);
- }
- }
- btrtl_coex.voice_packet_count = 0;
- mod_timer(&btrtl_coex.hogp_count_timer,
- jiffies + msecs_to_jiffies(1000));
- }
- #ifdef RTB_SOFTWARE_MAILBOX
- #ifndef RTK_COEX_OVER_SYMBOL
- static int udpsocket_send(char *tx_msg, int msg_size)
- {
- u8 error = 0;
- struct msghdr udpmsg;
- mm_segment_t oldfs;
- struct iovec iov;
- RTKBT_DBG("send msg %s with len:%d", tx_msg, msg_size);
- if (btrtl_coex.sock_open) {
- iov.iov_base = (void *)tx_msg;
- iov.iov_len = msg_size;
- udpmsg.msg_name = &btrtl_coex.wifi_addr;
- udpmsg.msg_namelen = sizeof(struct sockaddr_in);
- #if LINUX_VERSION_CODE < KERNEL_VERSION(3, 19, 0)
- udpmsg.msg_iov = &iov;
- udpmsg.msg_iovlen = 1;
- #else
- iov_iter_init(&udpmsg.msg_iter, WRITE, &iov, 1, msg_size);
- #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(btrtl_coex.udpsock, &udpmsg, msg_size);
- #else
- error = sock_sendmsg(btrtl_coex.udpsock, &udpmsg);
- #endif
- set_fs(oldfs);
- if (error < 0)
- RTKBT_DBG("Error when sendimg msg, error:%d", error);
- }
- return error;
- }
- #endif
- #ifdef RTK_COEX_OVER_SYMBOL
- /* Receive message from WiFi */
- u8 rtw_btcoex_wifi_to_bt(u8 *msg, u8 msg_size)
- {
- struct sk_buff *nskb;
- if (!rtw_coex_on) {
- RTKBT_WARN("Bluetooth is closed");
- return 0;
- }
- nskb = alloc_skb(msg_size, GFP_ATOMIC);
- if (!nskb) {
- RTKBT_ERR("Couldnt alloc skb for WiFi coex message");
- return 0;
- }
- memcpy(skb_put(nskb, msg_size), msg, msg_size);
- skb_queue_tail(&rtw_q, nskb);
- queue_work(rtw_wq, &rtw_work);
- return 1;
- }
- EXPORT_SYMBOL(rtw_btcoex_wifi_to_bt);
- static int rtk_send_coexmsg2wifi(u8 *msg, u8 size)
- {
- u8 result;
- u8 (*btmsg_to_wifi)(u8 *, u8);
- btmsg_to_wifi = __symbol_get(VMLINUX_SYMBOL_STR(rtw_btcoex_bt_to_wifi));
- if (!btmsg_to_wifi) {
- /* RTKBT_ERR("Couldnt get symbol"); */
- return -1;
- }
- result = btmsg_to_wifi(msg, size);
- __symbol_put(VMLINUX_SYMBOL_STR(rtw_btcoex_bt_to_wifi));
- if (!result) {
- RTKBT_ERR("Couldnt send coex msg to WiFi");
- return -1;
- } else if (result == 1){
- /* successful to send message */
- return 0;
- } else {
- RTKBT_ERR("Unknown result %d", result);
- return -1;
- }
- }
- static int rtkbt_process_coexskb(struct sk_buff *skb)
- {
- rtk_handle_event_from_wifi(skb->data);
- return 0;
- }
- static void rtw_work_func(struct work_struct *work)
- {
- struct sk_buff *skb;
- while ((skb = skb_dequeue(&rtw_q))) {
- rtkbt_process_coexskb(skb);
- kfree_skb(skb);
- }
- }
- #endif
- static int rtkbt_coexmsg_send(char *tx_msg, int msg_size)
- {
- #ifdef RTK_COEX_OVER_SYMBOL
- return rtk_send_coexmsg2wifi((uint8_t *)tx_msg, (u8)msg_size);
- #else
- return udpsocket_send(tx_msg, msg_size);
- #endif
- }
- #ifndef RTK_COEX_OVER_SYMBOL
- static void udpsocket_recv_data(void)
- {
- u8 recv_data[512];
- u32 len = 0;
- u16 recv_length;
- struct sk_buff *skb;
- RTKBT_DBG("-");
- spin_lock(&btrtl_coex.spin_lock_sock);
- len = skb_queue_len(&btrtl_coex.sk->sk_receive_queue);
- while (len > 0) {
- skb = skb_dequeue(&btrtl_coex.sk->sk_receive_queue);
- /*important: cut the udp header from skb->data! header length is 8 byte */
- recv_length = skb->len - 8;
- memset(recv_data, 0, sizeof(recv_data));
- memcpy(recv_data, skb->data + 8, recv_length);
- //RTKBT_DBG("received data: %s :with len %u", recv_data, recv_length);
- rtk_handle_event_from_wifi(recv_data);
- len--;
- kfree_skb(skb);
- }
- spin_unlock(&btrtl_coex.spin_lock_sock);
- }
- #if LINUX_VERSION_CODE < KERNEL_VERSION(3, 15, 0)
- static void udpsocket_recv(struct sock *sk, int bytes)
- #else
- static void udpsocket_recv(struct sock *sk)
- #endif
- {
- spin_lock(&btrtl_coex.spin_lock_sock);
- btrtl_coex.sk = sk;
- spin_unlock(&btrtl_coex.spin_lock_sock);
- queue_delayed_work(btrtl_coex.sock_wq, &btrtl_coex.sock_work, 0);
- }
- static void create_udpsocket(void)
- {
- int err;
- RTKBT_DBG("%s: connect_port: %d", __func__, CONNECT_PORT);
- btrtl_coex.sock_open = 0;
- err = sock_create(AF_INET, SOCK_DGRAM, IPPROTO_UDP,
- &btrtl_coex.udpsock);
- if (err < 0) {
- RTKBT_ERR("%s: sock create error, err = %d", __func__, err);
- return;
- }
- memset(&btrtl_coex.addr, 0, sizeof(struct sockaddr_in));
- btrtl_coex.addr.sin_family = AF_INET;
- btrtl_coex.addr.sin_addr.s_addr = htonl(INADDR_LOOPBACK);
- btrtl_coex.addr.sin_port = htons(CONNECT_PORT);
- memset(&btrtl_coex.wifi_addr, 0, sizeof(struct sockaddr_in));
- btrtl_coex.wifi_addr.sin_family = AF_INET;
- btrtl_coex.wifi_addr.sin_addr.s_addr = htonl(INADDR_LOOPBACK);
- btrtl_coex.wifi_addr.sin_port = htons(CONNECT_PORT_WIFI);
- err =
- btrtl_coex.udpsock->ops->bind(btrtl_coex.udpsock,
- (struct sockaddr *)&btrtl_coex.
- addr, sizeof(struct sockaddr));
- if (err < 0) {
- sock_release(btrtl_coex.udpsock);
- RTKBT_ERR("%s: sock bind error, err = %d",__func__, err);
- return;
- }
- btrtl_coex.sock_open = 1;
- btrtl_coex.udpsock->sk->sk_data_ready = udpsocket_recv;
- }
- #endif /* !RTK_COEX_OVER_SYMBOL */
- static void rtk_notify_extension_version_to_wifi(void)
- {
- uint8_t para_length = 2;
- char p_buf[2 + HCI_CMD_PREAMBLE_SIZE];
- char *p = p_buf;
- if (!btrtl_coex.wifi_on)
- return;
- UINT16_TO_STREAM(p, HCI_OP_HCI_EXTENSION_VERSION_NOTIFY);
- *p++ = para_length;
- UINT16_TO_STREAM(p, HCI_EXTENSION_VERSION);
- RTKBT_DBG("extension version is 0x%x", HCI_EXTENSION_VERSION);
- if (rtkbt_coexmsg_send(p_buf, para_length + HCI_CMD_PREAMBLE_SIZE) < 0)
- RTKBT_ERR("%s: sock send error", __func__);
- }
- static void rtk_notify_btpatch_version_to_wifi(void)
- {
- uint8_t para_length = 4;
- char p_buf[para_length + HCI_CMD_PREAMBLE_SIZE];
- char *p = p_buf;
- if (!btrtl_coex.wifi_on)
- return;
- UINT16_TO_STREAM(p, HCI_OP_HCI_BT_PATCH_VER_NOTIFY);
- *p++ = para_length;
- UINT16_TO_STREAM(p, btrtl_coex.hci_reversion);
- UINT16_TO_STREAM(p, btrtl_coex.lmp_subversion);
- RTKBT_DBG("btpatch ver: len %u, hci_rev 0x%04x, lmp_subver 0x%04x",
- para_length, btrtl_coex.hci_reversion,
- btrtl_coex.lmp_subversion);
- if (rtkbt_coexmsg_send(p_buf, para_length + HCI_CMD_PREAMBLE_SIZE) < 0)
- RTKBT_ERR("%s: sock send error", __func__);
- }
- static void rtk_notify_afhmap_to_wifi(void)
- {
- uint8_t para_length = 13;
- char p_buf[para_length + HCI_CMD_PREAMBLE_SIZE];
- char *p = p_buf;
- uint8_t kk = 0;
- if (!btrtl_coex.wifi_on)
- return;
- UINT16_TO_STREAM(p, HCI_OP_HCI_BT_AFH_MAP_NOTIFY);
- *p++ = para_length;
- *p++ = btrtl_coex.piconet_id;
- *p++ = btrtl_coex.mode;
- *p++ = 10;
- memcpy(p, btrtl_coex.afh_map, 10);
- RTKBT_DBG("afhmap, piconet_id is 0x%x, map type is 0x%x",
- btrtl_coex.piconet_id, btrtl_coex.mode);
- for (kk = 0; kk < 10; kk++)
- RTKBT_DBG("afhmap data[%d] is 0x%x", kk,
- btrtl_coex.afh_map[kk]);
- if (rtkbt_coexmsg_send(p_buf, para_length + HCI_CMD_PREAMBLE_SIZE) < 0)
- RTKBT_ERR("%s: sock send error", __func__);
- }
- static void rtk_notify_btcoex_to_wifi(uint8_t opcode, uint8_t status)
- {
- uint8_t para_length = 2;
- char p_buf[para_length + HCI_CMD_PREAMBLE_SIZE];
- char *p = p_buf;
- if (!btrtl_coex.wifi_on)
- return;
- UINT16_TO_STREAM(p, HCI_OP_HCI_BT_COEX_NOTIFY);
- *p++ = para_length;
- *p++ = opcode;
- if (!status)
- *p++ = 0;
- else
- *p++ = 1;
- RTKBT_DBG("btcoex, opcode is 0x%x, status is 0x%x", opcode, status);
- if (rtkbt_coexmsg_send(p_buf, para_length + HCI_CMD_PREAMBLE_SIZE) < 0)
- RTKBT_ERR("%s: sock send error", __func__);
- }
- static void rtk_notify_btoperation_to_wifi(uint8_t operation,
- uint8_t append_data_length,
- uint8_t * append_data)
- {
- uint8_t para_length = 3 + append_data_length;
- char p_buf[para_length + HCI_CMD_PREAMBLE_SIZE];
- char *p = p_buf;
- uint8_t kk = 0;
- if (!btrtl_coex.wifi_on)
- return;
- UINT16_TO_STREAM(p, HCI_OP_BT_OPERATION_NOTIFY);
- *p++ = para_length;
- *p++ = operation;
- *p++ = append_data_length;
- if (append_data_length)
- memcpy(p, append_data, append_data_length);
- RTKBT_DBG("btoperation: op 0x%02x, append_data_length %u",
- operation, append_data_length);
- if (append_data_length) {
- for (kk = 0; kk < append_data_length; kk++)
- RTKBT_DBG("append data is 0x%x", *(append_data + kk));
- }
- if (rtkbt_coexmsg_send(p_buf, para_length + HCI_CMD_PREAMBLE_SIZE) < 0)
- RTKBT_ERR("%s: sock send error", __func__);
- }
- static void rtk_notify_info_to_wifi(uint8_t reason, uint8_t length,
- uint8_t *report_info)
- {
- uint8_t para_length = 4 + length;
- char buf[para_length + HCI_CMD_PREAMBLE_SIZE];
- char *p = buf;
- struct rtl_btinfo *report = (struct rtl_btinfo *)report_info;
- if (length) {
- RTKBT_DBG("bt info: cmd %2.2X", report->cmd);
- RTKBT_DBG("bt info: len %2.2X", report->len);
- RTKBT_DBG("bt info: data %2.2X %2.2X %2.2X %2.2X %2.2X %2.2X",
- report->data[0], report->data[1], report->data[2],
- report->data[3], report->data[4], report->data[5]);
- }
- RTKBT_DBG("bt info: reason 0x%2x, length 0x%2x", reason, length);
- if (!btrtl_coex.wifi_on)
- return;
- UINT16_TO_STREAM(p, HCI_OP_HCI_BT_INFO_NOTIFY);
- *p++ = para_length;
- *p++ = btrtl_coex.polling_enable;
- *p++ = btrtl_coex.polling_interval;
- *p++ = reason;
- *p++ = length;
- if (length)
- memcpy(p, report_info, length);
- RTKBT_DBG("para length %2x, polling_enable %u, poiiling_interval %u",
- para_length, btrtl_coex.polling_enable,
- btrtl_coex.polling_interval);
- /* send BT INFO to Wi-Fi driver */
- if (rtkbt_coexmsg_send(buf, para_length + HCI_CMD_PREAMBLE_SIZE) < 0)
- RTKBT_ERR("%s: sock send error", __func__);
- }
- static void rtk_notify_regester_to_wifi(uint8_t * reg_value)
- {
- uint8_t para_length = 9;
- char p_buf[para_length + HCI_CMD_PREAMBLE_SIZE];
- char *p = p_buf;
- hci_mailbox_register *reg = (hci_mailbox_register *) reg_value;
- if (!btrtl_coex.wifi_on)
- return;
- UINT16_TO_STREAM(p, HCI_OP_HCI_BT_REGISTER_VALUE_NOTIFY);
- *p++ = para_length;
- memcpy(p, reg_value, para_length);
- RTKBT_DBG("bt register, register type is %x", reg->type);
- RTKBT_DBG("bt register, register offset is %x", reg->offset);
- RTKBT_DBG("bt register, register value is %x", reg->value);
- if (rtkbt_coexmsg_send(p_buf, para_length + HCI_CMD_PREAMBLE_SIZE) < 0)
- RTKBT_ERR("%s: sock send error", __func__);
- }
- #endif
- void rtk_btcoex_parse_cmd(uint8_t *buffer, int count)
- {
- u16 opcode = (buffer[0]) + (buffer[1] << 8);
- if (!test_bit(RTL_COEX_RUNNING, &btrtl_coex.flags)) {
- RTKBT_INFO("%s: Coex is closed, ignore", __func__);
- return;
- }
- switch (opcode) {
- case HCI_OP_INQUIRY:
- case HCI_OP_PERIODIC_INQ:
- if (!btrtl_coex.isinquirying) {
- btrtl_coex.isinquirying = 1;
- #ifdef RTB_SOFTWARE_MAILBOX
- RTKBT_DBG("hci (periodic)inq, notify wifi "
- "inquiry start");
- rtk_notify_btoperation_to_wifi(BT_OPCODE_INQUIRY_START,
- 0, NULL);
- #else
- RTKBT_INFO("hci (periodic)inq start");
- #endif
- }
- break;
- case HCI_OP_INQUIRY_CANCEL:
- case HCI_OP_EXIT_PERIODIC_INQ:
- if (btrtl_coex.isinquirying) {
- btrtl_coex.isinquirying = 0;
- #ifdef RTB_SOFTWARE_MAILBOX
- RTKBT_DBG("hci (periodic)inq cancel/exit, notify wifi "
- "inquiry stop");
- rtk_notify_btoperation_to_wifi(BT_OPCODE_INQUIRY_END, 0,
- NULL);
- #else
- RTKBT_INFO("hci (periodic)inq cancel/exit");
- #endif
- }
- break;
- case HCI_OP_ACCEPT_CONN_REQ:
- if (!btrtl_coex.ispaging) {
- btrtl_coex.ispaging = 1;
- #ifdef RTB_SOFTWARE_MAILBOX
- RTKBT_DBG("hci accept connreq, notify wifi page start");
- rtk_notify_btoperation_to_wifi(BT_OPCODE_PAGE_START, 0,
- NULL);
- #else
- RTKBT_INFO("hci accept conn req");
- #endif
- }
- break;
- case HCI_OP_DISCONNECT:
- RTKBT_INFO("HCI Disconnect, handle %04x, reason 0x%02x",
- ((u16)buffer[4] << 8 | buffer[3]), buffer[5]);
- break;
- default:
- break;
- }
- }
- static void rtk_handle_inquiry_complete(void)
- {
- if (btrtl_coex.isinquirying) {
- btrtl_coex.isinquirying = 0;
- #ifdef RTB_SOFTWARE_MAILBOX
- RTKBT_DBG("inq complete, notify wifi inquiry end");
- rtk_notify_btoperation_to_wifi(BT_OPCODE_INQUIRY_END, 0, NULL);
- #else
- RTKBT_INFO("inquiry complete");
- #endif
- }
- }
- static void rtk_handle_pin_code_req(void)
- {
- if (!btrtl_coex.ispairing) {
- btrtl_coex.ispairing = 1;
- #ifdef RTB_SOFTWARE_MAILBOX
- RTKBT_DBG("pin code req, notify wifi pair start");
- rtk_notify_btoperation_to_wifi(BT_OPCODE_PAIR_START, 0, NULL);
- #else
- RTKBT_INFO("pin code request");
- #endif
- }
- }
- static void rtk_handle_io_capa_req(void)
- {
- if (!btrtl_coex.ispairing) {
- btrtl_coex.ispairing = 1;
- #ifdef RTB_SOFTWARE_MAILBOX
- RTKBT_DBG("io cap req, notify wifi pair start");
- rtk_notify_btoperation_to_wifi(BT_OPCODE_PAIR_START, 0, NULL);
- #else
- RTKBT_INFO("io capability request");
- #endif
- }
- }
- static void rtk_handle_auth_request(void)
- {
- if (btrtl_coex.ispairing) {
- btrtl_coex.ispairing = 0;
- #ifdef RTB_SOFTWARE_MAILBOX
- RTKBT_DBG("auth req, notify wifi pair end");
- rtk_notify_btoperation_to_wifi(BT_OPCODE_PAIR_END, 0, NULL);
- #else
- RTKBT_INFO("authentication request");
- #endif
- }
- }
- static void rtk_handle_link_key_notify(void)
- {
- if (btrtl_coex.ispairing) {
- btrtl_coex.ispairing = 0;
- #ifdef RTB_SOFTWARE_MAILBOX
- RTKBT_DBG("link key notify, notify wifi pair end");
- rtk_notify_btoperation_to_wifi(BT_OPCODE_PAIR_END, 0, NULL);
- #else
- RTKBT_INFO("link key notify");
- #endif
- }
- }
- static void rtk_handle_mode_change_evt(u8 * p)
- {
- u16 mode_change_handle, mode_interval;
- p++;
- STREAM_TO_UINT16(mode_change_handle, p);
- p++;
- STREAM_TO_UINT16(mode_interval, p);
- update_hid_active_state(mode_change_handle, mode_interval);
- }
- #ifdef RTB_SOFTWARE_MAILBOX
- static void rtk_parse_vendor_mailbox_cmd_evt(u8 * p, u8 total_len)
- {
- u8 status, subcmd;
- u8 temp_cmd[10];
- status = *p++;
- if (total_len <= 4) {
- RTKBT_DBG("receive mailbox cmd from fw, total length <= 4");
- return;
- }
- subcmd = *p++;
- RTKBT_DBG("receive mailbox cmd from fw, subcmd is 0x%x, status is 0x%x",
- subcmd, status);
- switch (subcmd) {
- case HCI_VENDOR_SUB_CMD_BT_REPORT_CONN_SCO_INQ_INFO:
- if (status == 0) //success
- rtk_notify_info_to_wifi(POLLING_RESPONSE,
- RTL_BTINFO_LEN, (uint8_t *)p);
- break;
- case HCI_VENDOR_SUB_CMD_WIFI_CHANNEL_AND_BANDWIDTH_CMD:
- rtk_notify_btcoex_to_wifi(WIFI_BW_CHNL_NOTIFY, status);
- break;
- case HCI_VENDOR_SUB_CMD_WIFI_FORCE_TX_POWER_CMD:
- rtk_notify_btcoex_to_wifi(BT_POWER_DECREASE_CONTROL, status);
- break;
- case HCI_VENDOR_SUB_CMD_BT_ENABLE_IGNORE_WLAN_ACT_CMD:
- rtk_notify_btcoex_to_wifi(IGNORE_WLAN_ACTIVE_CONTROL, status);
- break;
- case HCI_VENDOR_SUB_CMD_SET_BT_PSD_MODE:
- rtk_notify_btcoex_to_wifi(BT_PSD_MODE_CONTROL, status);
- break;
- case HCI_VENDOR_SUB_CMD_SET_BT_LNA_CONSTRAINT:
- rtk_notify_btcoex_to_wifi(LNA_CONSTRAIN_CONTROL, status);
- break;
- case HCI_VENDOR_SUB_CMD_BT_AUTO_REPORT_ENABLE:
- break;
- case HCI_VENDOR_SUB_CMD_BT_SET_TXRETRY_REPORT_PARAM:
- break;
- case HCI_VENDOR_SUB_CMD_BT_SET_PTATABLE:
- break;
- case HCI_VENDOR_SUB_CMD_GET_AFH_MAP_L:
- if (status == 0) {
- memcpy(btrtl_coex.afh_map, p + 4, 4); /* cmd_idx, length, piconet_id, mode */
- temp_cmd[0] = HCI_VENDOR_SUB_CMD_GET_AFH_MAP_M;
- temp_cmd[1] = 2;
- temp_cmd[2] = btrtl_coex.piconet_id;
- temp_cmd[3] = btrtl_coex.mode;
- rtk_vendor_cmd_to_fw(HCI_VENDOR_MAILBOX_CMD, 4,
- temp_cmd);
- } else {
- memset(btrtl_coex.afh_map, 0, 10);
- rtk_notify_afhmap_to_wifi();
- }
- break;
- case HCI_VENDOR_SUB_CMD_GET_AFH_MAP_M:
- if (status == 0) {
- memcpy(btrtl_coex.afh_map + 4, p + 4, 4);
- temp_cmd[0] = HCI_VENDOR_SUB_CMD_GET_AFH_MAP_H;
- temp_cmd[1] = 2;
- temp_cmd[2] = btrtl_coex.piconet_id;
- temp_cmd[3] = btrtl_coex.mode;
- rtk_vendor_cmd_to_fw(HCI_VENDOR_MAILBOX_CMD, 4,
- temp_cmd);
- } else {
- memset(btrtl_coex.afh_map, 0, 10);
- rtk_notify_afhmap_to_wifi();
- }
- break;
- case HCI_VENDOR_SUB_CMD_GET_AFH_MAP_H:
- if (status == 0)
- memcpy(btrtl_coex.afh_map + 8, p + 4, 2);
- else
- memset(btrtl_coex.afh_map, 0, 10);
- rtk_notify_afhmap_to_wifi();
- break;
- case HCI_VENDOR_SUB_CMD_RD_REG_REQ:
- if (status == 0)
- rtk_notify_regester_to_wifi(p + 3); /* cmd_idx,length,regist type */
- break;
- case HCI_VENDOR_SUB_CMD_WR_REG_REQ:
- rtk_notify_btcoex_to_wifi(BT_REGISTER_ACCESS, status);
- break;
- default:
- break;
- }
- }
- #endif /* RTB_SOFTWARE_MAILBOX */
- static void rtk_handle_cmd_complete_evt(u8 total_len, u8 * p)
- {
- u16 opcode;
- p++;
- STREAM_TO_UINT16(opcode, p);
- //RTKBT_DBG("cmd_complete, opcode is 0x%x", opcode);
- if (opcode == HCI_OP_PERIODIC_INQ) {
- if (*p++ && btrtl_coex.isinquirying) {
- btrtl_coex.isinquirying = 0;
- #ifdef RTB_SOFTWARE_MAILBOX
- RTKBT_DBG("hci period inq, start error, notify wifi "
- "inquiry stop");
- rtk_notify_btoperation_to_wifi(BT_OPCODE_INQUIRY_END, 0,
- NULL);
- #else
- RTKBT_INFO("hci period inquiry start error");
- #endif
- }
- }
- if (opcode == HCI_OP_READ_LOCAL_VERSION) {
- if (!(*p++)) {
- p++;
- STREAM_TO_UINT16(btrtl_coex.hci_reversion, p);
- p += 3;
- STREAM_TO_UINT16(btrtl_coex.lmp_subversion, p);
- RTKBT_DBG("BTCOEX hci_rev 0x%04x",
- btrtl_coex.hci_reversion);
- RTKBT_DBG("BTCOEX lmp_subver 0x%04x",
- btrtl_coex.lmp_subversion);
- }
- }
- #ifdef RTB_SOFTWARE_MAILBOX
- if (opcode == HCI_VENDOR_MAILBOX_CMD) {
- rtk_parse_vendor_mailbox_cmd_evt(p, total_len);
- }
- #endif
- }
- static void rtk_handle_cmd_status_evt(u8 * p)
- {
- u16 opcode;
- u8 status;
- status = *p++;
- p++;
- STREAM_TO_UINT16(opcode, p);
- //RTKBT_DBG("cmd_status, opcode is 0x%x", opcode);
- if ((opcode == HCI_OP_INQUIRY) && (status)) {
- if (btrtl_coex.isinquirying) {
- btrtl_coex.isinquirying = 0;
- #ifdef RTB_SOFTWARE_MAILBOX
- RTKBT_DBG("hci inq, start error, notify wifi inq stop");
- rtk_notify_btoperation_to_wifi(BT_OPCODE_INQUIRY_END, 0,
- NULL);
- #else
- RTKBT_INFO("hci inquiry start error");
- #endif
- }
- }
- if (opcode == HCI_OP_CREATE_CONN) {
- if (!status && !btrtl_coex.ispaging) {
- btrtl_coex.ispaging = 1;
- #ifdef RTB_SOFTWARE_MAILBOX
- RTKBT_DBG("hci create conn, notify wifi start page");
- rtk_notify_btoperation_to_wifi(BT_OPCODE_PAGE_START, 0,
- NULL);
- #else
- RTKBT_INFO("hci create connection, start paging");
- #endif
- }
- }
- }
- static void rtk_handle_connection_complete_evt(u8 * p)
- {
- u16 handle;
- u8 status, link_type;
- rtk_conn_prof *hci_conn = NULL;
- status = *p++;
- STREAM_TO_UINT16(handle, p);
- p += 6;
- link_type = *p++;
- RTKBT_INFO("connected, handle %04x, status 0x%02x", handle, status);
- if (status == 0) {
- if (btrtl_coex.ispaging) {
- btrtl_coex.ispaging = 0;
- #ifdef RTB_SOFTWARE_MAILBOX
- RTKBT_DBG("notify wifi page success end");
- rtk_notify_btoperation_to_wifi
- (BT_OPCODE_PAGE_SUCCESS_END, 0, NULL);
- #else
- RTKBT_INFO("Page success");
- #endif
- }
- hci_conn = find_connection_by_handle(&btrtl_coex, handle);
- if (hci_conn == NULL) {
- hci_conn = allocate_connection_by_handle(handle);
- if (hci_conn) {
- add_connection_to_hash(&btrtl_coex,
- hci_conn);
- hci_conn->profile_bitmap = 0;
- memset(hci_conn->profile_refcount, 0, 8);
- if ((0 == link_type) || (2 == link_type)) { //sco or esco
- hci_conn->type = 1;
- update_profile_connection(hci_conn,
- profile_sco,
- TRUE);
- } else
- hci_conn->type = 0;
- } else {
- RTKBT_ERR("hci connection allocate fail");
- }
- } else {
- RTKBT_DBG("hci conn handle 0x%04x already existed!",
- handle);
- hci_conn->profile_bitmap = 0;
- memset(hci_conn->profile_refcount, 0, 8);
- if ((0 == link_type) || (2 == link_type)) { //sco or esco
- hci_conn->type = 1;
- update_profile_connection(hci_conn, profile_sco,
- TRUE);
- } else
- hci_conn->type = 0;
- }
- } else if (btrtl_coex.ispaging) {
- btrtl_coex.ispaging = 0;
- #ifdef RTB_SOFTWARE_MAILBOX
- RTKBT_DBG("notify wifi page unsuccess end");
- rtk_notify_btoperation_to_wifi(BT_OPCODE_PAGE_UNSUCCESS_END, 0,
- NULL);
- #else
- RTKBT_INFO("Page failed");
- #endif
- }
- }
- static void rtk_handle_le_connection_complete_evt(u8 enhanced, u8 * p)
- {
- u16 handle, interval;
- u8 status;
- rtk_conn_prof *hci_conn = NULL;
- status = *p++;
- STREAM_TO_UINT16(handle, p);
- if (!enhanced)
- p += 8; /* role, address type, address */
- else
- p += (8 + 12); /* plus two bluetooth addresses */
- STREAM_TO_UINT16(interval, p);
- RTKBT_INFO("LE connected, handle %04x, status 0x%02x, interval %u",
- handle, status, interval);
- if (status == 0) {
- if (btrtl_coex.ispaging) {
- btrtl_coex.ispaging = 0;
- #ifdef RTB_SOFTWARE_MAILBOX
- RTKBT_DBG("notify wifi page success end");
- rtk_notify_btoperation_to_wifi
- (BT_OPCODE_PAGE_SUCCESS_END, 0, NULL);
- #else
- RTKBT_INFO("Page success end");
- #endif
- }
- hci_conn = find_connection_by_handle(&btrtl_coex, handle);
- if (hci_conn == NULL) {
- hci_conn = allocate_connection_by_handle(handle);
- if (hci_conn) {
- add_connection_to_hash(&btrtl_coex,
- hci_conn);
- hci_conn->profile_bitmap = 0;
- memset(hci_conn->profile_refcount, 0, 8);
- hci_conn->type = 2;
- update_profile_connection(hci_conn, profile_hid, TRUE); //for coex, le is the same as hid
- update_hid_active_state(handle, interval);
- } else {
- RTKBT_ERR("hci connection allocate fail");
- }
- } else {
- RTKBT_DBG("hci conn handle 0x%04x already existed!",
- handle);
- hci_conn->profile_bitmap = 0;
- memset(hci_conn->profile_refcount, 0, 8);
- hci_conn->type = 2;
- update_profile_connection(hci_conn, profile_hid, TRUE);
- update_hid_active_state(handle, interval);
- }
- } else if (btrtl_coex.ispaging) {
- btrtl_coex.ispaging = 0;
- #ifdef RTB_SOFTWARE_MAILBOX
- RTKBT_DBG("notify wifi page unsuccess end");
- rtk_notify_btoperation_to_wifi(BT_OPCODE_PAGE_UNSUCCESS_END, 0,
- NULL);
- #else
- RTKBT_INFO("Page failed");
- #endif
- }
- }
- static void rtk_handle_le_connection_update_complete_evt(u8 * p)
- {
- u16 handle, interval;
- /* u8 status; */
- /* status = *p++; */
- p++;
- STREAM_TO_UINT16(handle, p);
- STREAM_TO_UINT16(interval, p);
- update_hid_active_state(handle, interval);
- }
- static void rtk_handle_le_meta_evt(u8 * p)
- {
- u8 sub_event = *p++;
- switch (sub_event) {
- case HCI_EV_LE_CONN_COMPLETE:
- rtk_handle_le_connection_complete_evt(0, p);
- break;
- case HCI_EV_LE_ENHANCED_CONN_COMPLETE:
- rtk_handle_le_connection_complete_evt(1, p);
- break;
- case HCI_EV_LE_CONN_UPDATE_COMPLETE:
- rtk_handle_le_connection_update_complete_evt(p);
- break;
- default:
- break;
- }
- }
- static u8 disconn_profile(struct rtl_hci_conn *conn, u8 pfe_index)
- {
- u8 need_update = 0;
- if (!btrtl_coex.profile_refcount[pfe_index]) {
- RTKBT_WARN("profile %u ref is 0", pfe_index);
- return 0;
- }
- btrtl_coex.profile_refcount[pfe_index]--;
- RTKBT_INFO("%s: profile_ref[%u] %u", __func__, pfe_index,
- btrtl_coex.profile_refcount[pfe_index]);
- if (!btrtl_coex.profile_refcount[pfe_index]) {
- need_update = 1;
- btrtl_coex.profile_bitmap &= ~(BIT(pfe_index));
- /* if profile does not exist, status is meaningless */
- btrtl_coex.profile_status &= ~(BIT(pfe_index));
- rtk_check_del_timer(pfe_index);
- }
- if (conn->profile_refcount[pfe_index])
- conn->profile_refcount[pfe_index]--;
- else
- RTKBT_INFO("%s: conn pfe ref[%u] is 0", __func__,
- conn->profile_refcount[pfe_index]);
- if (!conn->profile_refcount[pfe_index]) {
- need_update = 1;
- conn->profile_bitmap &= ~(BIT(pfe_index));
- /* clear profile_hid_interval if need */
- if ((profile_hid == pfe_index) &&
- (conn->profile_bitmap & (BIT(profile_hid_interval)))) {
- conn->profile_bitmap &= ~(BIT(profile_hid_interval));
- if (btrtl_coex.profile_refcount[profile_hid_interval])
- btrtl_coex.profile_refcount[profile_hid_interval]--;
- }
- }
- return need_update;
- }
- static void disconn_acl(u16 handle, struct rtl_hci_conn *conn)
- {
- struct rtl_coex_struct *coex = &btrtl_coex;
- rtk_prof_info *prof_info = NULL;
- struct list_head *iter = NULL, *temp = NULL;
- u8 need_update = 0;
- spin_lock(&coex->spin_lock_profile);
- list_for_each_safe(iter, temp, &coex->profile_list) {
- prof_info = list_entry(iter, rtk_prof_info, list);
- if (handle == prof_info->handle) {
- RTKBT_DBG("hci disconn, hndl %x, psm %x, dcid %x, "
- "scid %x, profile %u", prof_info->handle,
- prof_info->psm, prof_info->dcid,
- prof_info->scid, prof_info->profile_index);
- //If both scid and dcid > 0, L2cap connection is exist.
- need_update |= disconn_profile(conn,
- prof_info->profile_index);
- if ((prof_info->flags & A2DP_MEDIA) &&
- (conn->profile_bitmap & BIT(profile_sink)))
- need_update |= disconn_profile(conn,
- profile_sink);
- delete_profile_from_hash(prof_info);
- }
- }
- if (need_update)
- rtk_notify_profileinfo_to_fw();
- spin_unlock(&coex->spin_lock_profile);
- }
- static void rtk_handle_disconnect_complete_evt(u8 * p)
- {
- u16 handle;
- u8 status;
- u8 reason;
- rtk_conn_prof *hci_conn = NULL;
- if (btrtl_coex.ispairing) { //for slave: connection will be disconnected if authentication fail
- btrtl_coex.ispairing = 0;
- #ifdef RTB_SOFTWARE_MAILBOX
- RTKBT_DBG("hci disc complete, notify wifi pair end");
- rtk_notify_btoperation_to_wifi(BT_OPCODE_PAIR_END, 0, NULL);
- #else
- RTKBT_INFO("hci disconnection complete");
- #endif
- }
- status = *p++;
- STREAM_TO_UINT16(handle, p);
- reason = *p;
- RTKBT_INFO("disconn cmpl evt: status 0x%02x, handle %04x, reason 0x%02x",
- status, handle, reason);
- if (status == 0) {
- RTKBT_DBG("process disconn complete event.");
- hci_conn = find_connection_by_handle(&btrtl_coex, handle);
- if (hci_conn) {
- switch (hci_conn->type) {
- case 0:
- /* FIXME: If this is interrupted by l2cap rx,
- * there may be deadlock on spin_lock_profile */
- disconn_acl(handle, hci_conn);
- break;
- case 1:
- update_profile_connection(hci_conn, profile_sco,
- FALSE);
- break;
- case 2:
- update_profile_connection(hci_conn, profile_hid,
- FALSE);
- break;
- default:
- break;
- }
- delete_connection_from_hash(hci_conn);
- } else
- RTKBT_ERR("hci conn handle 0x%04x not found", handle);
- }
- }
- static void rtk_handle_specific_evt(u8 * p)
- {
- u16 subcode;
- STREAM_TO_UINT16(subcode, p);
- if (subcode == HCI_VENDOR_PTA_AUTO_REPORT_EVENT) {
- #ifdef RTB_SOFTWARE_MAILBOX
- RTKBT_DBG("notify wifi driver with autoreport data");
- rtk_notify_info_to_wifi(AUTO_REPORT, RTL_BTINFO_LEN,
- (uint8_t *)p);
- #else
- RTKBT_INFO("auto report data");
- #endif
- }
- }
- static void rtk_parse_event_data(struct rtl_coex_struct *coex,
- u8 *data, u16 len)
- {
- u8 *p = data;
- u8 event_code = *p++;
- u8 total_len = *p++;
- (void)coex;
- (void)&len;
- switch (event_code) {
- case HCI_EV_INQUIRY_COMPLETE:
- rtk_handle_inquiry_complete();
- break;
- case HCI_EV_PIN_CODE_REQ:
- rtk_handle_pin_code_req();
- break;
- case HCI_EV_IO_CAPA_REQUEST:
- rtk_handle_io_capa_req();
- break;
- case HCI_EV_AUTH_COMPLETE:
- rtk_handle_auth_request();
- break;
- case HCI_EV_LINK_KEY_NOTIFY:
- rtk_handle_link_key_notify();
- break;
- case HCI_EV_MODE_CHANGE:
- rtk_handle_mode_change_evt(p);
- break;
- case HCI_EV_CMD_COMPLETE:
- rtk_handle_cmd_complete_evt(total_len, p);
- break;
- case HCI_EV_CMD_STATUS:
- rtk_handle_cmd_status_evt(p);
- break;
- case HCI_EV_CONN_COMPLETE:
- case HCI_EV_SYNC_CONN_COMPLETE:
- rtk_handle_connection_complete_evt(p);
- break;
- case HCI_EV_DISCONN_COMPLETE:
- rtk_handle_disconnect_complete_evt(p);
- break;
- case HCI_EV_LE_META:
- rtk_handle_le_meta_evt(p);
- break;
- case HCI_EV_VENDOR_SPECIFIC:
- rtk_handle_specific_evt(p);
- break;
- default:
- break;
- }
- }
- const char l2_dir_str[][4] = {
- "RX", "TX",
- };
- void rtl_process_l2_sig(struct rtl_l2_buff *l2)
- {
- /* u8 flag; */
- u8 code;
- /* u8 identifier; */
- u16 handle;
- /* u16 total_len; */
- /* u16 pdu_len, channel_id; */
- /* u16 command_len; */
- u16 psm, scid, dcid, result;
- /* u16 status; */
- u8 *pp = l2->data;
- STREAM_TO_UINT16(handle, pp);
- /* flag = handle >> 12; */
- handle = handle & 0x0FFF;
- /* STREAM_TO_UINT16(total_len, pp); */
- pp += 2; /* data total length */
- /* STREAM_TO_UINT16(pdu_len, pp);
- * STREAM_TO_UINT16(channel_id, pp); */
- pp += 4; /* l2 len and channel id */
- code = *pp++;
- switch (code) {
- case L2CAP_CONN_REQ:
- /* identifier = *pp++; */
- pp++;
- /* STREAM_TO_UINT16(command_len, pp); */
- pp += 2;
- STREAM_TO_UINT16(psm, pp);
- STREAM_TO_UINT16(scid, pp);
- RTKBT_DBG("%s l2cap conn req, hndl 0x%04x, PSM 0x%04x, "
- "scid 0x%04x", l2_dir_str[l2->out], handle, psm,
- scid);
- handle_l2cap_con_req(handle, psm, scid, l2->out);
- break;
- case L2CAP_CONN_RSP:
- /* identifier = *pp++; */
- pp++;
- /* STREAM_TO_UINT16(command_len, pp); */
- pp += 2;
- STREAM_TO_UINT16(dcid, pp);
- STREAM_TO_UINT16(scid, pp);
- STREAM_TO_UINT16(result, pp);
- /* STREAM_TO_UINT16(status, pp); */
- pp += 2;
- RTKBT_DBG("%s l2cap conn rsp, hndl 0x%04x, dcid 0x%04x, "
- "scid 0x%04x, result 0x%04x", l2_dir_str[l2->out],
- handle, dcid, scid, result);
- handle_l2cap_con_rsp(handle, dcid, scid, l2->out, result);
- break;
- case L2CAP_DISCONN_REQ:
- /* identifier = *pp++; */
- pp++;
- /* STREAM_TO_UINT16(command_len, pp); */
- pp += 2;
- STREAM_TO_UINT16(dcid, pp);
- STREAM_TO_UINT16(scid, pp);
- RTKBT_DBG("%s l2cap disconn req, hndl 0x%04x, dcid 0x%04x, "
- "scid 0x%04x", l2_dir_str[l2->out], handle, dcid, scid);
- handle_l2cap_discon_req(handle, dcid, scid, l2->out);
- break;
- default:
- RTKBT_DBG("undesired l2 command %u", code);
- break;
- }
- }
- static void rtl_l2_data_process(u8 *pp, u16 len, int dir)
- {
- u8 code;
- u8 flag;
- u16 handle, pdu_len, channel_id;
- /* u16 total_len; */
- struct rtl_l2_buff *l2 = NULL;
- u8 *hd = pp;
- /* RTKBT_DBG("l2 sig data %p, len %u, dir %d", pp, len, dir); */
- STREAM_TO_UINT16(handle, pp);
- flag = handle >> 12;
- handle = handle & 0x0FFF;
- /* STREAM_TO_UINT16(total_len, pp); */
- pp += 2; /* data total length */
- STREAM_TO_UINT16(pdu_len, pp);
- STREAM_TO_UINT16(channel_id, pp);
- if (channel_id == 0x0001) {
- code = *pp++;
- switch (code) {
- case L2CAP_CONN_REQ:
- case L2CAP_CONN_RSP:
- case L2CAP_DISCONN_REQ:
- RTKBT_DBG("l2cap op %u, len %u, out %d", code, len,
- dir);
- l2 = rtl_l2_node_get(&btrtl_coex);
- if (l2) {
- u16 n;
- n = min_t(uint, len, L2_MAX_SUBSEC_LEN);
- memcpy(l2->data, hd, n);
- l2->out = dir;
- rtl_l2_node_to_used(&btrtl_coex, l2);
- queue_delayed_work(btrtl_coex.fw_wq,
- &btrtl_coex.l2_work, 0);
- } else
- RTKBT_ERR("%s: failed to get l2 node",
- __func__);
- break;
- case L2CAP_DISCONN_RSP:
- break;
- default:
- break;
- }
- } else {
- if ((flag != 0x01) && (is_profile_connected(profile_a2dp) ||
- is_profile_connected(profile_pan)))
- /* Do not count the continuous packets */
- packets_count(handle, channel_id, pdu_len, dir, pp);
- }
- return;
- }
- static void rtl_l2_work(struct work_struct *work)
- {
- struct rtl_coex_struct *coex;
- struct rtl_l2_buff *l2;
- unsigned long flags;
- coex = container_of(work, struct rtl_coex_struct, l2_work.work);
- spin_lock_irqsave(&coex->buff_lock, flags);
- while (!list_empty(&coex->l2_used_list)) {
- l2 = list_entry(coex->l2_used_list.next, struct rtl_l2_buff,
- list);
- list_del(&l2->list);
- spin_unlock_irqrestore(&coex->buff_lock, flags);
- rtl_process_l2_sig(l2);
- spin_lock_irqsave(&coex->buff_lock, flags);
- list_add_tail(&l2->list, &coex->l2_free_list);
- }
- spin_unlock_irqrestore(&coex->buff_lock, flags);
- return;
- }
- static void rtl_ev_work(struct work_struct *work)
- {
- struct rtl_coex_struct *coex;
- struct rtl_hci_ev *ev;
- unsigned long flags;
- coex = container_of(work, struct rtl_coex_struct, fw_work.work);
- spin_lock_irqsave(&coex->buff_lock, flags);
- while (!list_empty(&coex->ev_used_list)) {
- ev = list_entry(coex->ev_used_list.next, struct rtl_hci_ev,
- list);
- list_del(&ev->list);
- spin_unlock_irqrestore(&coex->buff_lock, flags);
- rtk_parse_event_data(coex, ev->data, ev->len);
- spin_lock_irqsave(&coex->buff_lock, flags);
- list_add_tail(&ev->list, &coex->ev_free_list);
- }
- spin_unlock_irqrestore(&coex->buff_lock, flags);
- }
- static inline int cmd_cmplt_filter_out(u8 *buf)
- {
- u16 opcode;
- opcode = buf[3] | (buf[4] << 8);
- switch (opcode) {
- case HCI_OP_PERIODIC_INQ:
- case HCI_OP_READ_LOCAL_VERSION:
- #ifdef RTB_SOFTWARE_MAILBOX
- case HCI_VENDOR_MAILBOX_CMD:
- #endif
- return 0;
- default:
- return 1;
- }
- }
- static inline int cmd_status_filter_out(u8 *buf)
- {
- u16 opcode;
- opcode = buf[4] | (buf[5] << 8);
- switch (opcode) {
- case HCI_OP_INQUIRY:
- case HCI_OP_CREATE_CONN:
- return 0;
- default:
- return 1;
- }
- }
- int ev_filter_out(u8 *buf)
- {
- switch (buf[0]) {
- case HCI_EV_INQUIRY_COMPLETE:
- case HCI_EV_PIN_CODE_REQ:
- case HCI_EV_IO_CAPA_REQUEST:
- case HCI_EV_AUTH_COMPLETE:
- case HCI_EV_LINK_KEY_NOTIFY:
- case HCI_EV_MODE_CHANGE:
- case HCI_EV_CONN_COMPLETE:
- case HCI_EV_SYNC_CONN_COMPLETE:
- case HCI_EV_DISCONN_COMPLETE:
- case HCI_EV_VENDOR_SPECIFIC:
- return 0;
- case HCI_EV_LE_META:
- /* Ignore frequent but not useful events that result in
- * costing too much space.
- */
- switch (buf[2]) {
- case HCI_EV_LE_CONN_COMPLETE:
- case HCI_EV_LE_ENHANCED_CONN_COMPLETE:
- case HCI_EV_LE_CONN_UPDATE_COMPLETE:
- return 0;
- }
- return 1;
- case HCI_EV_CMD_COMPLETE:
- return cmd_cmplt_filter_out(buf);
- case HCI_EV_CMD_STATUS:
- return cmd_status_filter_out(buf);
- default:
- return 1;
- }
- }
- static void rtk_btcoex_evt_enqueue(__u8 *s, __u16 count)
- {
- struct rtl_hci_ev *ev;
- if (ev_filter_out(s))
- return;
- ev = rtl_ev_node_get(&btrtl_coex);
- if (!ev) {
- RTKBT_ERR("%s: no free ev node.", __func__);
- return;
- }
- if (count > MAX_LEN_OF_HCI_EV) {
- memcpy(ev->data, s, MAX_LEN_OF_HCI_EV);
- ev->len = MAX_LEN_OF_HCI_EV;
- } else {
- memcpy(ev->data, s, count);
- ev->len = count;
- }
- rtl_ev_node_to_used(&btrtl_coex, ev);
- queue_delayed_work(btrtl_coex.fw_wq, &btrtl_coex.fw_work, 0);
- }
- /* Context: in_interrupt() */
- void rtk_btcoex_parse_event(uint8_t *buffer, int count)
- {
- struct rtl_coex_struct *coex = &btrtl_coex;
- __u8 *tbuff;
- __u16 elen = 0;
- /* RTKBT_DBG("%s: parse ev.", __func__); */
- if (!test_bit(RTL_COEX_RUNNING, &btrtl_coex.flags)) {
- /* RTKBT_INFO("%s: Coex is closed, ignore", __func__); */
- RTKBT_INFO("%s: Coex is closed, ignore %x, %x",
- __func__, buffer[0], buffer[1]);
- return;
- }
- spin_lock(&coex->rxlock);
- /* coex->tbuff will be set to NULL when initializing or
- * there is a complete frame or there is start of a frame */
- tbuff = coex->tbuff;
- while (count) {
- int len;
- /* Start of a frame */
- if (!tbuff) {
- tbuff = coex->back_buff;
- coex->tbuff = NULL;
- coex->elen = 0;
- coex->pkt_type = HCI_EVENT_PKT;
- coex->expect = HCI_EVENT_HDR_SIZE;
- }
- len = min_t(uint, coex->expect, count);
- memcpy(tbuff, buffer, len);
- tbuff += len;
- coex->elen += len;
- count -= len;
- buffer += len;
- coex->expect -= len;
- if (coex->elen == HCI_EVENT_HDR_SIZE) {
- /* Complete event header */
- coex->expect =
- ((struct hci_event_hdr *)coex->back_buff)->plen;
- if (coex->expect > HCI_MAX_EVENT_SIZE - coex->elen) {
- tbuff = NULL;
- coex->elen = 0;
- RTKBT_ERR("tbuff room is not enough");
- break;
- }
- }
- if (coex->expect == 0) {
- /* Complete frame */
- elen = coex->elen;
- spin_unlock(&coex->rxlock);
- rtk_btcoex_evt_enqueue(coex->back_buff, elen);
- spin_lock(&coex->rxlock);
- tbuff = NULL;
- coex->elen = 0;
- }
- }
- /* coex->tbuff would be non-NULL if there isn't a complete frame
- * And it will be updated next time */
- coex->tbuff = tbuff;
- spin_unlock(&coex->rxlock);
- }
- void rtk_btcoex_parse_l2cap_data_tx(uint8_t *buffer, int count)
- {
- if (!test_bit(RTL_COEX_RUNNING, &btrtl_coex.flags)) {
- RTKBT_INFO("%s: Coex is closed, ignore", __func__);
- return;
- }
- rtl_l2_data_process(buffer, count, 1);
- //u16 handle, total_len, pdu_len, channel_ID, command_len, psm, scid,
- // dcid, result, status;
- //u8 flag, code, identifier;
- //u8 *pp = (u8 *) (skb->data);
- //STREAM_TO_UINT16(handle, pp);
- //flag = handle >> 12;
- //handle = handle & 0x0FFF;
- //STREAM_TO_UINT16(total_len, pp);
- //STREAM_TO_UINT16(pdu_len, pp);
- //STREAM_TO_UINT16(channel_ID, pp);
- //if (channel_ID == 0x0001) {
- // code = *pp++;
- // switch (code) {
- // case L2CAP_CONN_REQ:
- // identifier = *pp++;
- // STREAM_TO_UINT16(command_len, pp);
- // STREAM_TO_UINT16(psm, pp);
- // STREAM_TO_UINT16(scid, pp);
- // RTKBT_DBG("TX l2cap conn req, hndl %x, PSM %x, scid=%x",
- // handle, psm, scid);
- // handle_l2cap_con_req(handle, psm, scid, 1);
- // break;
- // case L2CAP_CONN_RSP:
- // identifier = *pp++;
- // STREAM_TO_UINT16(command_len, pp);
- // STREAM_TO_UINT16(dcid, pp);
- // STREAM_TO_UINT16(scid, pp);
- // STREAM_TO_UINT16(result, pp);
- // STREAM_TO_UINT16(status, pp);
- // RTKBT_DBG("TX l2cap conn rsp, hndl %x, dcid %x, "
- // "scid %x, result %x",
- // handle, dcid, scid, result);
- // handle_l2cap_con_rsp(handle, dcid, scid, 1, result);
- // break;
- // case L2CAP_DISCONN_REQ:
- // identifier = *pp++;
- // STREAM_TO_UINT16(command_len, pp);
- // STREAM_TO_UINT16(dcid, pp);
- // STREAM_TO_UINT16(scid, pp);
- // RTKBT_DBG("TX l2cap disconn req, hndl %x, dcid %x, "
- // "scid %x", handle, dcid, scid);
- // handle_l2cap_discon_req(handle, dcid, scid, 1);
- // break;
- // case L2CAP_DISCONN_RSP:
- // break;
- // default:
- // break;
- // }
- //} else {
- // if ((flag != 0x01) && (is_profile_connected(profile_a2dp) || is_profile_connected(profile_pan))) //Do not count the continuous packets
- // packets_count(handle, channel_ID, pdu_len, 1, pp);
- //}
- }
- void rtk_btcoex_parse_l2cap_data_rx(uint8_t *buffer, int count)
- {
- if (!test_bit(RTL_COEX_RUNNING, &btrtl_coex.flags)) {
- RTKBT_INFO("%s: Coex is closed, ignore", __func__);
- return;
- }
- rtl_l2_data_process(buffer, count, 0);
- //u16 handle, total_len, pdu_len, channel_ID, command_len, psm, scid,
- // dcid, result, status;
- //u8 flag, code, identifier;
- //u8 *pp = urb->transfer_buffer;
- //STREAM_TO_UINT16(handle, pp);
- //flag = handle >> 12;
- //handle = handle & 0x0FFF;
- //STREAM_TO_UINT16(total_len, pp);
- //STREAM_TO_UINT16(pdu_len, pp);
- //STREAM_TO_UINT16(channel_ID, pp);
- //if (channel_ID == 0x0001) {
- // code = *pp++;
- // switch (code) {
- // case L2CAP_CONN_REQ:
- // identifier = *pp++;
- // STREAM_TO_UINT16(command_len, pp);
- // STREAM_TO_UINT16(psm, pp);
- // STREAM_TO_UINT16(scid, pp);
- // RTKBT_DBG("RX l2cap conn req, hndl %x, PSM %x, scid %x",
- // handle, psm, scid);
- // handle_l2cap_con_req(handle, psm, scid, 0);
- // break;
- // case L2CAP_CONN_RSP:
- // identifier = *pp++;
- // STREAM_TO_UINT16(command_len, pp);
- // STREAM_TO_UINT16(dcid, pp);
- // STREAM_TO_UINT16(scid, pp);
- // STREAM_TO_UINT16(result, pp);
- // STREAM_TO_UINT16(status, pp);
- // RTKBT_DBG("RX l2cap conn rsp, hndl %x, dcid %x, "
- // "scid %x, result %x",
- // handle, dcid, scid, result);
- // handle_l2cap_con_rsp(handle, dcid, scid, 0, result);
- // break;
- // case L2CAP_DISCONN_REQ:
- // identifier = *pp++;
- // STREAM_TO_UINT16(command_len, pp);
- // STREAM_TO_UINT16(dcid, pp);
- // STREAM_TO_UINT16(scid, pp);
- // RTKBT_DBG("RX l2cap disconn req, hndl %x, dcid %x, "
- // "scid %x", handle, dcid, scid);
- // handle_l2cap_discon_req(handle, dcid, scid, 0);
- // break;
- // case L2CAP_DISCONN_RSP:
- // break;
- // default:
- // break;
- // }
- //} else {
- // if ((flag != 0x01) && (is_profile_connected(profile_a2dp) || is_profile_connected(profile_pan))) //Do not count the continuous packets
- // packets_count(handle, channel_ID, pdu_len, 0, pp);
- //}
- }
- #ifdef RTB_SOFTWARE_MAILBOX
- #if LINUX_VERSION_CODE > KERNEL_VERSION(4, 14, 0)
- static void polling_bt_info(struct timer_list *unused)
- #else
- static void polling_bt_info(unsigned long data)
- #endif
- {
- uint8_t temp_cmd[1];
- RTKBT_DBG("polling timer");
- if (btrtl_coex.polling_enable) {
- //temp_cmd[0] = HCI_VENDOR_SUB_CMD_BT_REPORT_CONN_SCO_INQ_INFO;
- temp_cmd[0] = HCI_VENDOR_SUB_CMD_BT_AUTO_REPORT_STATUS_INFO;
- rtk_vendor_cmd_to_fw(HCI_VENDOR_MAILBOX_CMD, 1, temp_cmd);
- }
- mod_timer(&btrtl_coex.polling_timer,
- jiffies + msecs_to_jiffies(1000 * btrtl_coex.polling_interval));
- }
- static void rtk_handle_bt_info_control(uint8_t *p)
- {
- uint8_t temp_cmd[20];
- struct rtl_btinfo_ctl *ctl = (struct rtl_btinfo_ctl*)p;
- RTKBT_DBG("Received polling_enable %u, polling_time %u, "
- "autoreport_enable %u", ctl->polling_enable,
- ctl->polling_time, ctl->autoreport_enable);
- RTKBT_DBG("coex: original polling_enable %u",
- btrtl_coex.polling_enable);
- if (ctl->polling_enable && !btrtl_coex.polling_enable) {
- /* setup polling timer for getting bt info from firmware */
- btrtl_coex.polling_timer.expires =
- jiffies + msecs_to_jiffies(ctl->polling_time * 1000);
- mod_timer(&btrtl_coex.polling_timer,
- btrtl_coex.polling_timer.expires);
- }
- /* Close bt info polling timer */
- if (!ctl->polling_enable && btrtl_coex.polling_enable)
- del_timer(&btrtl_coex.polling_timer);
- if (btrtl_coex.autoreport != ctl->autoreport_enable) {
- temp_cmd[0] = HCI_VENDOR_SUB_CMD_BT_AUTO_REPORT_ENABLE;
- temp_cmd[1] = 1;
- temp_cmd[2] = ctl->autoreport_enable;
- rtk_vendor_cmd_to_fw(HCI_VENDOR_MAILBOX_CMD, 3, temp_cmd);
- }
- btrtl_coex.polling_enable = ctl->polling_enable;
- btrtl_coex.polling_interval = ctl->polling_time;
- btrtl_coex.autoreport = ctl->autoreport_enable;
- rtk_notify_info_to_wifi(HOST_RESPONSE, 0, NULL);
- }
- static void rtk_handle_bt_coex_control(uint8_t * p)
- {
- uint8_t temp_cmd[20];
- uint8_t opcode, opcode_len, value, power_decrease, psd_mode,
- access_type;
- opcode = *p++;
- RTKBT_DBG("receive bt coex control event from wifi, op 0x%02x", opcode);
- switch (opcode) {
- case BT_PATCH_VERSION_QUERY:
- rtk_notify_btpatch_version_to_wifi();
- break;
- case IGNORE_WLAN_ACTIVE_CONTROL:
- opcode_len = *p++;
- value = *p++;
- temp_cmd[0] = HCI_VENDOR_SUB_CMD_BT_ENABLE_IGNORE_WLAN_ACT_CMD;
- temp_cmd[1] = 1;
- temp_cmd[2] = value;
- rtk_vendor_cmd_to_fw(HCI_VENDOR_MAILBOX_CMD, 3, temp_cmd);
- break;
- case LNA_CONSTRAIN_CONTROL:
- opcode_len = *p++;
- value = *p++;
- temp_cmd[0] = HCI_VENDOR_SUB_CMD_SET_BT_LNA_CONSTRAINT;
- temp_cmd[1] = 1;
- temp_cmd[2] = value;
- rtk_vendor_cmd_to_fw(HCI_VENDOR_MAILBOX_CMD, 3, temp_cmd);
- break;
- case BT_POWER_DECREASE_CONTROL:
- opcode_len = *p++;
- power_decrease = *p++;
- temp_cmd[0] = HCI_VENDOR_SUB_CMD_WIFI_FORCE_TX_POWER_CMD;
- temp_cmd[1] = 1;
- temp_cmd[2] = power_decrease;
- rtk_vendor_cmd_to_fw(HCI_VENDOR_MAILBOX_CMD, 3, temp_cmd);
- break;
- case BT_PSD_MODE_CONTROL:
- opcode_len = *p++;
- psd_mode = *p++;
- temp_cmd[0] = HCI_VENDOR_SUB_CMD_SET_BT_PSD_MODE;
- temp_cmd[1] = 1;
- temp_cmd[2] = psd_mode;
- rtk_vendor_cmd_to_fw(HCI_VENDOR_MAILBOX_CMD, 3, temp_cmd);
- break;
- case WIFI_BW_CHNL_NOTIFY:
- opcode_len = *p++;
- temp_cmd[0] = HCI_VENDOR_SUB_CMD_WIFI_CHANNEL_AND_BANDWIDTH_CMD;
- temp_cmd[1] = 3;
- memcpy(temp_cmd + 2, p, 3); //wifi_state, wifi_centralchannel, chnnels_btnotuse
- rtk_vendor_cmd_to_fw(HCI_VENDOR_MAILBOX_CMD, 5, temp_cmd);
- break;
- case QUERY_BT_AFH_MAP:
- opcode_len = *p++;
- btrtl_coex.piconet_id = *p++;
- btrtl_coex.mode = *p++;
- temp_cmd[0] = HCI_VENDOR_SUB_CMD_GET_AFH_MAP_L;
- temp_cmd[1] = 2;
- temp_cmd[2] = btrtl_coex.piconet_id;
- temp_cmd[3] = btrtl_coex.mode;
- rtk_vendor_cmd_to_fw(HCI_VENDOR_MAILBOX_CMD, 4, temp_cmd);
- break;
- case BT_REGISTER_ACCESS:
- opcode_len = *p++;
- access_type = *p++;
- if (access_type == 0) { //read
- temp_cmd[0] = HCI_VENDOR_SUB_CMD_RD_REG_REQ;
- temp_cmd[1] = 5;
- temp_cmd[2] = *p++;
- memcpy(temp_cmd + 3, p, 4);
- rtk_vendor_cmd_to_fw(HCI_VENDOR_MAILBOX_CMD, 7,
- temp_cmd);
- } else { //write
- temp_cmd[0] = HCI_VENDOR_SUB_CMD_RD_REG_REQ;
- temp_cmd[1] = 5;
- temp_cmd[2] = *p++;
- memcpy(temp_cmd + 3, p, 8);
- rtk_vendor_cmd_to_fw(HCI_VENDOR_MAILBOX_CMD, 11,
- temp_cmd);
- }
- break;
- default:
- break;
- }
- }
- static void rtk_handle_event_from_wifi(uint8_t * msg)
- {
- uint8_t *p = msg;
- uint8_t event_code = *p++;
- uint8_t total_length;
- uint8_t extension_event;
- uint8_t operation;
- uint16_t wifi_opcode;
- uint8_t op_status;
- if (memcmp(msg, invite_rsp, sizeof(invite_rsp)) == 0) {
- RTKBT_DBG("receive invite rsp from wifi, wifi is already on");
- btrtl_coex.wifi_on = 1;
- rtk_notify_extension_version_to_wifi();
- }
- if (memcmp(msg, attend_req, sizeof(attend_req)) == 0) {
- RTKBT_DBG("receive attend req from wifi, wifi turn on");
- btrtl_coex.wifi_on = 1;
- rtkbt_coexmsg_send(attend_ack, sizeof(attend_ack));
- rtk_notify_extension_version_to_wifi();
- }
- if (memcmp(msg, wifi_leave, sizeof(wifi_leave)) == 0) {
- RTKBT_DBG("receive wifi leave from wifi, wifi turn off");
- btrtl_coex.wifi_on = 0;
- rtkbt_coexmsg_send(leave_ack, sizeof(leave_ack));
- if (btrtl_coex.polling_enable) {
- btrtl_coex.polling_enable = 0;
- del_timer(&btrtl_coex.polling_timer);
- }
- }
- if (memcmp(msg, leave_ack, sizeof(leave_ack)) == 0) {
- RTKBT_DBG("receive leave ack from wifi");
- }
- if (event_code == 0xFE) {
- total_length = *p++;
- extension_event = *p++;
- switch (extension_event) {
- case RTK_HS_EXTENSION_EVENT_WIFI_SCAN:
- operation = *p;
- RTKBT_DBG("Recv WiFi scan notify event from WiFi, "
- "op 0x%02x", operation);
- break;
- case RTK_HS_EXTENSION_EVENT_HCI_BT_INFO_CONTROL:
- rtk_handle_bt_info_control(p);
- break;
- case RTK_HS_EXTENSION_EVENT_HCI_BT_COEX_CONTROL:
- rtk_handle_bt_coex_control(p);
- break;
- default:
- break;
- }
- }
- if (event_code == 0x0E) {
- p += 2; //length, number of complete packets
- STREAM_TO_UINT16(wifi_opcode, p);
- op_status = *p;
- RTKBT_DBG("Recv cmd complete event from WiFi, op 0x%02x, "
- "status 0x%02x", wifi_opcode, op_status);
- }
- }
- #endif /* RTB_SOFTWARE_MAILBOX */
- static inline void rtl_free_frags(struct rtl_coex_struct *coex)
- {
- unsigned long flags;
- spin_lock_irqsave(&coex->rxlock, flags);
- coex->elen = 0;
- coex->tbuff = NULL;
- spin_unlock_irqrestore(&coex->rxlock, flags);
- }
- void rtk_btcoex_open(struct hci_dev *hdev)
- {
- if (test_and_set_bit(RTL_COEX_RUNNING, &btrtl_coex.flags)) {
- RTKBT_WARN("RTL COEX is already running.");
- return;
- }
- RTKBT_INFO("Open BTCOEX");
- /* Just for test */
- //struct rtl_btinfo_ctl ctl;
- INIT_DELAYED_WORK(&btrtl_coex.fw_work, (void *)rtl_ev_work);
- #ifdef RTB_SOFTWARE_MAILBOX
- #ifdef RTK_COEX_OVER_SYMBOL
- INIT_WORK(&rtw_work, rtw_work_func);
- skb_queue_head_init(&rtw_q);
- rtw_coex_on = 1;
- #else
- INIT_DELAYED_WORK(&btrtl_coex.sock_work,
- (void *)udpsocket_recv_data);
- #endif
- #endif /* RTB_SOFTWARE_MAILBOX */
- INIT_DELAYED_WORK(&btrtl_coex.l2_work, (void *)rtl_l2_work);
- #if LINUX_VERSION_CODE > KERNEL_VERSION(4, 14, 0)
- #ifdef RTB_SOFTWARE_MAILBOX
- timer_setup(&btrtl_coex.polling_timer, polling_bt_info, 0);
- #endif
- timer_setup(&btrtl_coex.a2dp_count_timer, count_a2dp_packet_timeout, 0);
- timer_setup(&btrtl_coex.pan_count_timer, count_pan_packet_timeout, 0);
- timer_setup(&btrtl_coex.hogp_count_timer, count_hogp_packet_timeout, 0);
- #else
- #ifdef RTB_SOFTWARE_MAILBOX
- setup_timer(&btrtl_coex.polling_timer, polling_bt_info, 0);
- #endif
- setup_timer(&btrtl_coex.a2dp_count_timer, count_a2dp_packet_timeout, 0);
- setup_timer(&btrtl_coex.pan_count_timer, count_pan_packet_timeout, 0);
- setup_timer(&btrtl_coex.hogp_count_timer, count_hogp_packet_timeout, 0);
- #endif
- btrtl_coex.hdev = hdev;
- #ifdef RTB_SOFTWARE_MAILBOX
- btrtl_coex.wifi_on = 0;
- #endif
- init_profile_hash(&btrtl_coex);
- init_connection_hash(&btrtl_coex);
- btrtl_coex.pkt_type = 0;
- btrtl_coex.expect = 0;
- btrtl_coex.elen = 0;
- btrtl_coex.tbuff = NULL;
- #ifdef RTB_SOFTWARE_MAILBOX
- #ifndef RTK_COEX_OVER_SYMBOL
- create_udpsocket();
- #endif
- rtkbt_coexmsg_send(invite_req, sizeof(invite_req));
- #endif
- /* Just for test */
- //ctl.polling_enable = 1;
- //ctl.polling_time = 1;
- //ctl.autoreport_enable = 1;
- //rtk_handle_bt_info_control((u8 *)&ctl);
- }
- void rtk_btcoex_close(void)
- {
- int kk = 0;
- if (!test_and_clear_bit(RTL_COEX_RUNNING, &btrtl_coex.flags)) {
- RTKBT_WARN("RTL COEX is already closed.");
- return;
- }
- RTKBT_INFO("Close BTCOEX");
- #ifdef RTB_SOFTWARE_MAILBOX
- /* Close coex socket */
- if (btrtl_coex.wifi_on)
- rtkbt_coexmsg_send(bt_leave, sizeof(bt_leave));
- #ifdef RTK_COEX_OVER_SYMBOL
- rtw_coex_on = 0;
- skb_queue_purge(&rtw_q);
- cancel_work_sync(&rtw_work);
- #else
- cancel_delayed_work_sync(&btrtl_coex.sock_work);
- if (btrtl_coex.sock_open) {
- btrtl_coex.sock_open = 0;
- RTKBT_DBG("release udp socket");
- sock_release(btrtl_coex.udpsock);
- }
- #endif
- /* Delete all timers */
- if (btrtl_coex.polling_enable) {
- btrtl_coex.polling_enable = 0;
- del_timer_sync(&(btrtl_coex.polling_timer));
- }
- #endif /* RTB_SOFTWARE_MAILBOX */
- del_timer_sync(&btrtl_coex.a2dp_count_timer);
- del_timer_sync(&btrtl_coex.pan_count_timer);
- del_timer_sync(&btrtl_coex.hogp_count_timer);
- cancel_delayed_work_sync(&btrtl_coex.fw_work);
- cancel_delayed_work_sync(&btrtl_coex.l2_work);
- flush_connection_hash(&btrtl_coex);
- flush_profile_hash(&btrtl_coex);
- btrtl_coex.profile_bitmap = 0;
- btrtl_coex.profile_status = 0;
- for (kk = 0; kk < 8; kk++)
- btrtl_coex.profile_refcount[kk] = 0;
- rtl_free_frags(&btrtl_coex);
- RTKBT_DBG("-x");
- }
- void rtk_btcoex_probe(struct hci_dev *hdev)
- {
- btrtl_coex.hdev = hdev;
- spin_lock_init(&btrtl_coex.spin_lock_sock);
- spin_lock_init(&btrtl_coex.spin_lock_profile);
- }
- void rtk_btcoex_init(void)
- {
- RTKBT_DBG("%s: version: %s", __func__, RTK_VERSION);
- RTKBT_DBG("create workqueue");
- #ifdef RTB_SOFTWARE_MAILBOX
- #ifdef RTK_COEX_OVER_SYMBOL
- RTKBT_INFO("Coex over Symbol");
- rtw_wq = create_workqueue("btcoexwork");
- skb_queue_head_init(&rtw_q);
- #else
- RTKBT_INFO("Coex over UDP");
- btrtl_coex.sock_wq = create_workqueue("btudpwork");
- #endif
- #endif /* RTB_SOFTWARE_MAILBOX */
- btrtl_coex.fw_wq = create_workqueue("btfwwork");
- rtl_alloc_buff(&btrtl_coex);
- spin_lock_init(&btrtl_coex.rxlock);
- }
- void rtk_btcoex_exit(void)
- {
- RTKBT_DBG("%s: destroy workqueue", __func__);
- #ifdef RTB_SOFTWARE_MAILBOX
- #ifdef RTK_COEX_OVER_SYMBOL
- flush_workqueue(rtw_wq);
- destroy_workqueue(rtw_wq);
- #else
- flush_workqueue(btrtl_coex.sock_wq);
- destroy_workqueue(btrtl_coex.sock_wq);
- #endif
- #endif
- flush_workqueue(btrtl_coex.fw_wq);
- destroy_workqueue(btrtl_coex.fw_wq);
- rtl_free_buff(&btrtl_coex);
- }
|