12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646 |
- /*
- BlueZ - Bluetooth protocol stack for Linux
- Copyright (C) 2010 Nokia Corporation
- 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;
- 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 OF THIRD PARTY RIGHTS.
- IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
- CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
- WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
- ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
- OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
- ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
- COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
- SOFTWARE IS DISCLAIMED.
- */
- /* Bluetooth HCI Management interface */
- #include <linux/uaccess.h>
- #include <asm/unaligned.h>
- #include <net/bluetooth/bluetooth.h>
- #include <net/bluetooth/hci_core.h>
- #include <net/bluetooth/mgmt.h>
- #define MGMT_VERSION 0
- #define MGMT_REVISION 1
- struct pending_cmd {
- struct list_head list;
- __u16 opcode;
- int index;
- void *cmd;
- struct sock *sk;
- void *user_data;
- };
- LIST_HEAD(cmd_list);
- static int cmd_status(struct sock *sk, u16 cmd, u8 status)
- {
- struct sk_buff *skb;
- struct mgmt_hdr *hdr;
- struct mgmt_ev_cmd_status *ev;
- BT_DBG("sock %p", sk);
- skb = alloc_skb(sizeof(*hdr) + sizeof(*ev), GFP_ATOMIC);
- if (!skb)
- return -ENOMEM;
- hdr = (void *) skb_put(skb, sizeof(*hdr));
- hdr->opcode = cpu_to_le16(MGMT_EV_CMD_STATUS);
- hdr->len = cpu_to_le16(sizeof(*ev));
- ev = (void *) skb_put(skb, sizeof(*ev));
- ev->status = status;
- put_unaligned_le16(cmd, &ev->opcode);
- if (sock_queue_rcv_skb(sk, skb) < 0)
- kfree_skb(skb);
- return 0;
- }
- static int cmd_complete(struct sock *sk, u16 cmd, void *rp, size_t rp_len)
- {
- struct sk_buff *skb;
- struct mgmt_hdr *hdr;
- struct mgmt_ev_cmd_complete *ev;
- BT_DBG("sock %p", sk);
- skb = alloc_skb(sizeof(*hdr) + sizeof(*ev) + rp_len, GFP_ATOMIC);
- if (!skb)
- return -ENOMEM;
- hdr = (void *) skb_put(skb, sizeof(*hdr));
- hdr->opcode = cpu_to_le16(MGMT_EV_CMD_COMPLETE);
- hdr->len = cpu_to_le16(sizeof(*ev) + rp_len);
- ev = (void *) skb_put(skb, sizeof(*ev) + rp_len);
- put_unaligned_le16(cmd, &ev->opcode);
- memcpy(ev->data, rp, rp_len);
- if (sock_queue_rcv_skb(sk, skb) < 0)
- kfree_skb(skb);
- return 0;
- }
- static int read_version(struct sock *sk)
- {
- struct mgmt_rp_read_version rp;
- BT_DBG("sock %p", sk);
- rp.version = MGMT_VERSION;
- put_unaligned_le16(MGMT_REVISION, &rp.revision);
- return cmd_complete(sk, MGMT_OP_READ_VERSION, &rp, sizeof(rp));
- }
- static int read_index_list(struct sock *sk)
- {
- struct mgmt_rp_read_index_list *rp;
- struct list_head *p;
- size_t rp_len;
- u16 count;
- int i, err;
- BT_DBG("sock %p", sk);
- read_lock(&hci_dev_list_lock);
- count = 0;
- list_for_each(p, &hci_dev_list) {
- count++;
- }
- rp_len = sizeof(*rp) + (2 * count);
- rp = kmalloc(rp_len, GFP_ATOMIC);
- if (!rp) {
- read_unlock(&hci_dev_list_lock);
- return -ENOMEM;
- }
- put_unaligned_le16(count, &rp->num_controllers);
- i = 0;
- list_for_each(p, &hci_dev_list) {
- struct hci_dev *d = list_entry(p, struct hci_dev, list);
- hci_del_off_timer(d);
- set_bit(HCI_MGMT, &d->flags);
- if (test_bit(HCI_SETUP, &d->flags))
- continue;
- put_unaligned_le16(d->id, &rp->index[i++]);
- BT_DBG("Added hci%u", d->id);
- }
- read_unlock(&hci_dev_list_lock);
- err = cmd_complete(sk, MGMT_OP_READ_INDEX_LIST, rp, rp_len);
- kfree(rp);
- return err;
- }
- static int read_controller_info(struct sock *sk, unsigned char *data, u16 len)
- {
- struct mgmt_rp_read_info rp;
- struct mgmt_cp_read_info *cp = (void *) data;
- struct hci_dev *hdev;
- u16 dev_id;
- BT_DBG("sock %p", sk);
- if (len != 2)
- return cmd_status(sk, MGMT_OP_READ_INFO, EINVAL);
- dev_id = get_unaligned_le16(&cp->index);
- BT_DBG("request for hci%u", dev_id);
- hdev = hci_dev_get(dev_id);
- if (!hdev)
- return cmd_status(sk, MGMT_OP_READ_INFO, ENODEV);
- hci_del_off_timer(hdev);
- hci_dev_lock_bh(hdev);
- set_bit(HCI_MGMT, &hdev->flags);
- put_unaligned_le16(hdev->id, &rp.index);
- rp.type = hdev->dev_type;
- rp.powered = test_bit(HCI_UP, &hdev->flags);
- rp.connectable = test_bit(HCI_PSCAN, &hdev->flags);
- rp.discoverable = test_bit(HCI_ISCAN, &hdev->flags);
- rp.pairable = test_bit(HCI_PSCAN, &hdev->flags);
- if (test_bit(HCI_AUTH, &hdev->flags))
- rp.sec_mode = 3;
- else if (hdev->ssp_mode > 0)
- rp.sec_mode = 4;
- else
- rp.sec_mode = 2;
- bacpy(&rp.bdaddr, &hdev->bdaddr);
- memcpy(rp.features, hdev->features, 8);
- memcpy(rp.dev_class, hdev->dev_class, 3);
- put_unaligned_le16(hdev->manufacturer, &rp.manufacturer);
- rp.hci_ver = hdev->hci_ver;
- put_unaligned_le16(hdev->hci_rev, &rp.hci_rev);
- hci_dev_unlock_bh(hdev);
- hci_dev_put(hdev);
- return cmd_complete(sk, MGMT_OP_READ_INFO, &rp, sizeof(rp));
- }
- static void mgmt_pending_free(struct pending_cmd *cmd)
- {
- sock_put(cmd->sk);
- kfree(cmd->cmd);
- kfree(cmd);
- }
- static struct pending_cmd *mgmt_pending_add(struct sock *sk, u16 opcode,
- u16 index, void *data, u16 len)
- {
- struct pending_cmd *cmd;
- cmd = kmalloc(sizeof(*cmd), GFP_ATOMIC);
- if (!cmd)
- return NULL;
- cmd->opcode = opcode;
- cmd->index = index;
- cmd->cmd = kmalloc(len, GFP_ATOMIC);
- if (!cmd->cmd) {
- kfree(cmd);
- return NULL;
- }
- memcpy(cmd->cmd, data, len);
- cmd->sk = sk;
- sock_hold(sk);
- list_add(&cmd->list, &cmd_list);
- return cmd;
- }
- static void mgmt_pending_foreach(u16 opcode, int index,
- void (*cb)(struct pending_cmd *cmd, void *data),
- void *data)
- {
- struct list_head *p, *n;
- list_for_each_safe(p, n, &cmd_list) {
- struct pending_cmd *cmd;
- cmd = list_entry(p, struct pending_cmd, list);
- if (cmd->opcode != opcode)
- continue;
- if (index >= 0 && cmd->index != index)
- continue;
- cb(cmd, data);
- }
- }
- static struct pending_cmd *mgmt_pending_find(u16 opcode, int index)
- {
- struct list_head *p;
- list_for_each(p, &cmd_list) {
- struct pending_cmd *cmd;
- cmd = list_entry(p, struct pending_cmd, list);
- if (cmd->opcode != opcode)
- continue;
- if (index >= 0 && cmd->index != index)
- continue;
- return cmd;
- }
- return NULL;
- }
- static void mgmt_pending_remove(u16 opcode, int index)
- {
- struct pending_cmd *cmd;
- cmd = mgmt_pending_find(opcode, index);
- if (cmd == NULL)
- return;
- list_del(&cmd->list);
- mgmt_pending_free(cmd);
- }
- static int set_powered(struct sock *sk, unsigned char *data, u16 len)
- {
- struct mgmt_mode *cp;
- struct hci_dev *hdev;
- struct pending_cmd *cmd;
- u16 dev_id;
- int err, up;
- cp = (void *) data;
- dev_id = get_unaligned_le16(&cp->index);
- BT_DBG("request for hci%u", dev_id);
- hdev = hci_dev_get(dev_id);
- if (!hdev)
- return cmd_status(sk, MGMT_OP_SET_POWERED, ENODEV);
- hci_dev_lock_bh(hdev);
- up = test_bit(HCI_UP, &hdev->flags);
- if ((cp->val && up) || (!cp->val && !up)) {
- err = cmd_status(sk, MGMT_OP_SET_POWERED, EALREADY);
- goto failed;
- }
- if (mgmt_pending_find(MGMT_OP_SET_POWERED, dev_id)) {
- err = cmd_status(sk, MGMT_OP_SET_POWERED, EBUSY);
- goto failed;
- }
- cmd = mgmt_pending_add(sk, MGMT_OP_SET_POWERED, dev_id, data, len);
- if (!cmd) {
- err = -ENOMEM;
- goto failed;
- }
- if (cp->val)
- queue_work(hdev->workqueue, &hdev->power_on);
- else
- queue_work(hdev->workqueue, &hdev->power_off);
- err = 0;
- failed:
- hci_dev_unlock_bh(hdev);
- hci_dev_put(hdev);
- return err;
- }
- static int set_discoverable(struct sock *sk, unsigned char *data, u16 len)
- {
- struct mgmt_mode *cp;
- struct hci_dev *hdev;
- struct pending_cmd *cmd;
- u16 dev_id;
- u8 scan;
- int err;
- cp = (void *) data;
- dev_id = get_unaligned_le16(&cp->index);
- BT_DBG("request for hci%u", dev_id);
- hdev = hci_dev_get(dev_id);
- if (!hdev)
- return cmd_status(sk, MGMT_OP_SET_DISCOVERABLE, ENODEV);
- hci_dev_lock_bh(hdev);
- if (!test_bit(HCI_UP, &hdev->flags)) {
- err = cmd_status(sk, MGMT_OP_SET_DISCOVERABLE, ENETDOWN);
- goto failed;
- }
- if (mgmt_pending_find(MGMT_OP_SET_DISCOVERABLE, dev_id) ||
- mgmt_pending_find(MGMT_OP_SET_CONNECTABLE, dev_id)) {
- err = cmd_status(sk, MGMT_OP_SET_DISCOVERABLE, EBUSY);
- goto failed;
- }
- if (cp->val == test_bit(HCI_ISCAN, &hdev->flags) &&
- test_bit(HCI_PSCAN, &hdev->flags)) {
- err = cmd_status(sk, MGMT_OP_SET_DISCOVERABLE, EALREADY);
- goto failed;
- }
- cmd = mgmt_pending_add(sk, MGMT_OP_SET_DISCOVERABLE, dev_id, data, len);
- if (!cmd) {
- err = -ENOMEM;
- goto failed;
- }
- scan = SCAN_PAGE;
- if (cp->val)
- scan |= SCAN_INQUIRY;
- err = hci_send_cmd(hdev, HCI_OP_WRITE_SCAN_ENABLE, 1, &scan);
- if (err < 0)
- mgmt_pending_remove(MGMT_OP_SET_DISCOVERABLE, dev_id);
- failed:
- hci_dev_unlock_bh(hdev);
- hci_dev_put(hdev);
- return err;
- }
- static int set_connectable(struct sock *sk, unsigned char *data, u16 len)
- {
- struct mgmt_mode *cp;
- struct hci_dev *hdev;
- struct pending_cmd *cmd;
- u16 dev_id;
- u8 scan;
- int err;
- cp = (void *) data;
- dev_id = get_unaligned_le16(&cp->index);
- BT_DBG("request for hci%u", dev_id);
- hdev = hci_dev_get(dev_id);
- if (!hdev)
- return cmd_status(sk, MGMT_OP_SET_CONNECTABLE, ENODEV);
- hci_dev_lock_bh(hdev);
- if (!test_bit(HCI_UP, &hdev->flags)) {
- err = cmd_status(sk, MGMT_OP_SET_CONNECTABLE, ENETDOWN);
- goto failed;
- }
- if (mgmt_pending_find(MGMT_OP_SET_DISCOVERABLE, dev_id) ||
- mgmt_pending_find(MGMT_OP_SET_CONNECTABLE, dev_id)) {
- err = cmd_status(sk, MGMT_OP_SET_CONNECTABLE, EBUSY);
- goto failed;
- }
- if (cp->val == test_bit(HCI_PSCAN, &hdev->flags)) {
- err = cmd_status(sk, MGMT_OP_SET_CONNECTABLE, EALREADY);
- goto failed;
- }
- cmd = mgmt_pending_add(sk, MGMT_OP_SET_CONNECTABLE, dev_id, data, len);
- if (!cmd) {
- err = -ENOMEM;
- goto failed;
- }
- if (cp->val)
- scan = SCAN_PAGE;
- else
- scan = 0;
- err = hci_send_cmd(hdev, HCI_OP_WRITE_SCAN_ENABLE, 1, &scan);
- if (err < 0)
- mgmt_pending_remove(MGMT_OP_SET_CONNECTABLE, dev_id);
- failed:
- hci_dev_unlock_bh(hdev);
- hci_dev_put(hdev);
- return err;
- }
- static int mgmt_event(u16 event, void *data, u16 data_len, struct sock *skip_sk)
- {
- struct sk_buff *skb;
- struct mgmt_hdr *hdr;
- skb = alloc_skb(sizeof(*hdr) + data_len, GFP_ATOMIC);
- if (!skb)
- return -ENOMEM;
- bt_cb(skb)->channel = HCI_CHANNEL_CONTROL;
- hdr = (void *) skb_put(skb, sizeof(*hdr));
- hdr->opcode = cpu_to_le16(event);
- hdr->len = cpu_to_le16(data_len);
- memcpy(skb_put(skb, data_len), data, data_len);
- hci_send_to_sock(NULL, skb, skip_sk);
- kfree_skb(skb);
- return 0;
- }
- static int send_mode_rsp(struct sock *sk, u16 opcode, u16 index, u8 val)
- {
- struct mgmt_mode rp;
- put_unaligned_le16(index, &rp.index);
- rp.val = val;
- return cmd_complete(sk, opcode, &rp, sizeof(rp));
- }
- static int set_pairable(struct sock *sk, unsigned char *data, u16 len)
- {
- struct mgmt_mode *cp, ev;
- struct hci_dev *hdev;
- u16 dev_id;
- int err;
- cp = (void *) data;
- dev_id = get_unaligned_le16(&cp->index);
- BT_DBG("request for hci%u", dev_id);
- hdev = hci_dev_get(dev_id);
- if (!hdev)
- return cmd_status(sk, MGMT_OP_SET_PAIRABLE, ENODEV);
- hci_dev_lock_bh(hdev);
- if (cp->val)
- set_bit(HCI_PAIRABLE, &hdev->flags);
- else
- clear_bit(HCI_PAIRABLE, &hdev->flags);
- err = send_mode_rsp(sk, MGMT_OP_SET_PAIRABLE, dev_id, cp->val);
- if (err < 0)
- goto failed;
- put_unaligned_le16(dev_id, &ev.index);
- ev.val = cp->val;
- err = mgmt_event(MGMT_EV_PAIRABLE, &ev, sizeof(ev), sk);
- failed:
- hci_dev_unlock_bh(hdev);
- hci_dev_put(hdev);
- return err;
- }
- static u8 get_service_classes(struct hci_dev *hdev)
- {
- struct list_head *p;
- u8 val = 0;
- list_for_each(p, &hdev->uuids) {
- struct bt_uuid *uuid = list_entry(p, struct bt_uuid, list);
- val |= uuid->svc_hint;
- }
- return val;
- }
- static int update_class(struct hci_dev *hdev)
- {
- u8 cod[3];
- BT_DBG("%s", hdev->name);
- if (test_bit(HCI_SERVICE_CACHE, &hdev->flags))
- return 0;
- cod[0] = hdev->minor_class;
- cod[1] = hdev->major_class;
- cod[2] = get_service_classes(hdev);
- if (memcmp(cod, hdev->dev_class, 3) == 0)
- return 0;
- return hci_send_cmd(hdev, HCI_OP_WRITE_CLASS_OF_DEV, sizeof(cod), cod);
- }
- static int add_uuid(struct sock *sk, unsigned char *data, u16 len)
- {
- struct mgmt_cp_add_uuid *cp;
- struct hci_dev *hdev;
- struct bt_uuid *uuid;
- u16 dev_id;
- int err;
- cp = (void *) data;
- dev_id = get_unaligned_le16(&cp->index);
- BT_DBG("request for hci%u", dev_id);
- hdev = hci_dev_get(dev_id);
- if (!hdev)
- return cmd_status(sk, MGMT_OP_ADD_UUID, ENODEV);
- hci_dev_lock_bh(hdev);
- uuid = kmalloc(sizeof(*uuid), GFP_ATOMIC);
- if (!uuid) {
- err = -ENOMEM;
- goto failed;
- }
- memcpy(uuid->uuid, cp->uuid, 16);
- uuid->svc_hint = cp->svc_hint;
- list_add(&uuid->list, &hdev->uuids);
- err = update_class(hdev);
- if (err < 0)
- goto failed;
- err = cmd_complete(sk, MGMT_OP_ADD_UUID, &dev_id, sizeof(dev_id));
- failed:
- hci_dev_unlock_bh(hdev);
- hci_dev_put(hdev);
- return err;
- }
- static int remove_uuid(struct sock *sk, unsigned char *data, u16 len)
- {
- struct list_head *p, *n;
- struct mgmt_cp_add_uuid *cp;
- struct hci_dev *hdev;
- u8 bt_uuid_any[] = { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 };
- u16 dev_id;
- int err, found;
- cp = (void *) data;
- dev_id = get_unaligned_le16(&cp->index);
- BT_DBG("request for hci%u", dev_id);
- hdev = hci_dev_get(dev_id);
- if (!hdev)
- return cmd_status(sk, MGMT_OP_REMOVE_UUID, ENODEV);
- hci_dev_lock_bh(hdev);
- if (memcmp(cp->uuid, bt_uuid_any, 16) == 0) {
- err = hci_uuids_clear(hdev);
- goto unlock;
- }
- found = 0;
- list_for_each_safe(p, n, &hdev->uuids) {
- struct bt_uuid *match = list_entry(p, struct bt_uuid, list);
- if (memcmp(match->uuid, cp->uuid, 16) != 0)
- continue;
- list_del(&match->list);
- found++;
- }
- if (found == 0) {
- err = cmd_status(sk, MGMT_OP_REMOVE_UUID, ENOENT);
- goto unlock;
- }
- err = update_class(hdev);
- if (err < 0)
- goto unlock;
- err = cmd_complete(sk, MGMT_OP_REMOVE_UUID, &dev_id, sizeof(dev_id));
- unlock:
- hci_dev_unlock_bh(hdev);
- hci_dev_put(hdev);
- return err;
- }
- static int set_dev_class(struct sock *sk, unsigned char *data, u16 len)
- {
- struct hci_dev *hdev;
- struct mgmt_cp_set_dev_class *cp;
- u16 dev_id;
- int err;
- cp = (void *) data;
- dev_id = get_unaligned_le16(&cp->index);
- BT_DBG("request for hci%u", dev_id);
- hdev = hci_dev_get(dev_id);
- if (!hdev)
- return cmd_status(sk, MGMT_OP_SET_DEV_CLASS, ENODEV);
- hci_dev_lock_bh(hdev);
- hdev->major_class = cp->major;
- hdev->minor_class = cp->minor;
- err = update_class(hdev);
- if (err == 0)
- err = cmd_complete(sk, MGMT_OP_SET_DEV_CLASS, &dev_id,
- sizeof(dev_id));
- hci_dev_unlock_bh(hdev);
- hci_dev_put(hdev);
- return err;
- }
- static int set_service_cache(struct sock *sk, unsigned char *data, u16 len)
- {
- struct hci_dev *hdev;
- struct mgmt_cp_set_service_cache *cp;
- u16 dev_id;
- int err;
- cp = (void *) data;
- dev_id = get_unaligned_le16(&cp->index);
- hdev = hci_dev_get(dev_id);
- if (!hdev)
- return cmd_status(sk, MGMT_OP_SET_SERVICE_CACHE, ENODEV);
- hci_dev_lock_bh(hdev);
- BT_DBG("hci%u enable %d", dev_id, cp->enable);
- if (cp->enable) {
- set_bit(HCI_SERVICE_CACHE, &hdev->flags);
- err = 0;
- } else {
- clear_bit(HCI_SERVICE_CACHE, &hdev->flags);
- err = update_class(hdev);
- }
- if (err == 0)
- err = cmd_complete(sk, MGMT_OP_SET_SERVICE_CACHE, &dev_id,
- sizeof(dev_id));
- hci_dev_unlock_bh(hdev);
- hci_dev_put(hdev);
- return err;
- }
- static int load_keys(struct sock *sk, unsigned char *data, u16 len)
- {
- struct hci_dev *hdev;
- struct mgmt_cp_load_keys *cp;
- u16 dev_id, key_count, expected_len;
- int i;
- cp = (void *) data;
- dev_id = get_unaligned_le16(&cp->index);
- key_count = get_unaligned_le16(&cp->key_count);
- expected_len = sizeof(*cp) + key_count * sizeof(struct mgmt_key_info);
- if (expected_len != len) {
- BT_ERR("load_keys: expected %u bytes, got %u bytes",
- len, expected_len);
- return -EINVAL;
- }
- hdev = hci_dev_get(dev_id);
- if (!hdev)
- return cmd_status(sk, MGMT_OP_LOAD_KEYS, ENODEV);
- BT_DBG("hci%u debug_keys %u key_count %u", dev_id, cp->debug_keys,
- key_count);
- hci_dev_lock_bh(hdev);
- hci_link_keys_clear(hdev);
- set_bit(HCI_LINK_KEYS, &hdev->flags);
- if (cp->debug_keys)
- set_bit(HCI_DEBUG_KEYS, &hdev->flags);
- else
- clear_bit(HCI_DEBUG_KEYS, &hdev->flags);
- for (i = 0; i < key_count; i++) {
- struct mgmt_key_info *key = &cp->keys[i];
- hci_add_link_key(hdev, 0, &key->bdaddr, key->val, key->type,
- key->pin_len);
- }
- hci_dev_unlock_bh(hdev);
- hci_dev_put(hdev);
- return 0;
- }
- static int remove_key(struct sock *sk, unsigned char *data, u16 len)
- {
- struct hci_dev *hdev;
- struct mgmt_cp_remove_key *cp;
- struct hci_conn *conn;
- u16 dev_id;
- int err;
- cp = (void *) data;
- dev_id = get_unaligned_le16(&cp->index);
- hdev = hci_dev_get(dev_id);
- if (!hdev)
- return cmd_status(sk, MGMT_OP_REMOVE_KEY, ENODEV);
- hci_dev_lock_bh(hdev);
- err = hci_remove_link_key(hdev, &cp->bdaddr);
- if (err < 0) {
- err = cmd_status(sk, MGMT_OP_REMOVE_KEY, -err);
- goto unlock;
- }
- err = 0;
- if (!test_bit(HCI_UP, &hdev->flags) || !cp->disconnect)
- goto unlock;
- conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
- if (conn) {
- struct hci_cp_disconnect dc;
- put_unaligned_le16(conn->handle, &dc.handle);
- dc.reason = 0x13; /* Remote User Terminated Connection */
- err = hci_send_cmd(hdev, HCI_OP_DISCONNECT, 0, NULL);
- }
- unlock:
- hci_dev_unlock_bh(hdev);
- hci_dev_put(hdev);
- return err;
- }
- static int disconnect(struct sock *sk, unsigned char *data, u16 len)
- {
- struct hci_dev *hdev;
- struct mgmt_cp_disconnect *cp;
- struct hci_cp_disconnect dc;
- struct pending_cmd *cmd;
- struct hci_conn *conn;
- u16 dev_id;
- int err;
- BT_DBG("");
- cp = (void *) data;
- dev_id = get_unaligned_le16(&cp->index);
- hdev = hci_dev_get(dev_id);
- if (!hdev)
- return cmd_status(sk, MGMT_OP_DISCONNECT, ENODEV);
- hci_dev_lock_bh(hdev);
- if (!test_bit(HCI_UP, &hdev->flags)) {
- err = cmd_status(sk, MGMT_OP_DISCONNECT, ENETDOWN);
- goto failed;
- }
- if (mgmt_pending_find(MGMT_OP_DISCONNECT, dev_id)) {
- err = cmd_status(sk, MGMT_OP_DISCONNECT, EBUSY);
- goto failed;
- }
- conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
- if (!conn) {
- err = cmd_status(sk, MGMT_OP_DISCONNECT, ENOTCONN);
- goto failed;
- }
- cmd = mgmt_pending_add(sk, MGMT_OP_DISCONNECT, dev_id, data, len);
- if (!cmd) {
- err = -ENOMEM;
- goto failed;
- }
- put_unaligned_le16(conn->handle, &dc.handle);
- dc.reason = 0x13; /* Remote User Terminated Connection */
- err = hci_send_cmd(hdev, HCI_OP_DISCONNECT, sizeof(dc), &dc);
- if (err < 0)
- mgmt_pending_remove(MGMT_OP_DISCONNECT, dev_id);
- failed:
- hci_dev_unlock_bh(hdev);
- hci_dev_put(hdev);
- return err;
- }
- static int get_connections(struct sock *sk, unsigned char *data, u16 len)
- {
- struct mgmt_cp_get_connections *cp;
- struct mgmt_rp_get_connections *rp;
- struct hci_dev *hdev;
- struct list_head *p;
- size_t rp_len;
- u16 dev_id, count;
- int i, err;
- BT_DBG("");
- cp = (void *) data;
- dev_id = get_unaligned_le16(&cp->index);
- hdev = hci_dev_get(dev_id);
- if (!hdev)
- return cmd_status(sk, MGMT_OP_GET_CONNECTIONS, ENODEV);
- hci_dev_lock_bh(hdev);
- count = 0;
- list_for_each(p, &hdev->conn_hash.list) {
- count++;
- }
- rp_len = sizeof(*rp) + (count * sizeof(bdaddr_t));
- rp = kmalloc(rp_len, GFP_ATOMIC);
- if (!rp) {
- err = -ENOMEM;
- goto unlock;
- }
- put_unaligned_le16(dev_id, &rp->index);
- put_unaligned_le16(count, &rp->conn_count);
- read_lock(&hci_dev_list_lock);
- i = 0;
- list_for_each(p, &hdev->conn_hash.list) {
- struct hci_conn *c = list_entry(p, struct hci_conn, list);
- bacpy(&rp->conn[i++], &c->dst);
- }
- read_unlock(&hci_dev_list_lock);
- err = cmd_complete(sk, MGMT_OP_GET_CONNECTIONS, rp, rp_len);
- unlock:
- kfree(rp);
- hci_dev_unlock_bh(hdev);
- hci_dev_put(hdev);
- return err;
- }
- static int pin_code_reply(struct sock *sk, unsigned char *data, u16 len)
- {
- struct hci_dev *hdev;
- struct mgmt_cp_pin_code_reply *cp;
- struct hci_cp_pin_code_reply reply;
- struct pending_cmd *cmd;
- u16 dev_id;
- int err;
- BT_DBG("");
- cp = (void *) data;
- dev_id = get_unaligned_le16(&cp->index);
- hdev = hci_dev_get(dev_id);
- if (!hdev)
- return cmd_status(sk, MGMT_OP_DISCONNECT, ENODEV);
- hci_dev_lock_bh(hdev);
- if (!test_bit(HCI_UP, &hdev->flags)) {
- err = cmd_status(sk, MGMT_OP_PIN_CODE_REPLY, ENETDOWN);
- goto failed;
- }
- cmd = mgmt_pending_add(sk, MGMT_OP_PIN_CODE_REPLY, dev_id, data, len);
- if (!cmd) {
- err = -ENOMEM;
- goto failed;
- }
- bacpy(&reply.bdaddr, &cp->bdaddr);
- reply.pin_len = cp->pin_len;
- memcpy(reply.pin_code, cp->pin_code, 16);
- err = hci_send_cmd(hdev, HCI_OP_PIN_CODE_REPLY, sizeof(reply), &reply);
- if (err < 0)
- mgmt_pending_remove(MGMT_OP_PIN_CODE_REPLY, dev_id);
- failed:
- hci_dev_unlock_bh(hdev);
- hci_dev_put(hdev);
- return err;
- }
- static int pin_code_neg_reply(struct sock *sk, unsigned char *data, u16 len)
- {
- struct hci_dev *hdev;
- struct mgmt_cp_pin_code_neg_reply *cp;
- struct pending_cmd *cmd;
- u16 dev_id;
- int err;
- BT_DBG("");
- cp = (void *) data;
- dev_id = get_unaligned_le16(&cp->index);
- hdev = hci_dev_get(dev_id);
- if (!hdev)
- return cmd_status(sk, MGMT_OP_PIN_CODE_NEG_REPLY, ENODEV);
- hci_dev_lock_bh(hdev);
- if (!test_bit(HCI_UP, &hdev->flags)) {
- err = cmd_status(sk, MGMT_OP_PIN_CODE_NEG_REPLY, ENETDOWN);
- goto failed;
- }
- cmd = mgmt_pending_add(sk, MGMT_OP_PIN_CODE_NEG_REPLY, dev_id,
- data, len);
- if (!cmd) {
- err = -ENOMEM;
- goto failed;
- }
- err = hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY, sizeof(bdaddr_t),
- &cp->bdaddr);
- if (err < 0)
- mgmt_pending_remove(MGMT_OP_PIN_CODE_NEG_REPLY, dev_id);
- failed:
- hci_dev_unlock_bh(hdev);
- hci_dev_put(hdev);
- return err;
- }
- static int set_io_capability(struct sock *sk, unsigned char *data, u16 len)
- {
- struct hci_dev *hdev;
- struct mgmt_cp_set_io_capability *cp;
- u16 dev_id;
- BT_DBG("");
- cp = (void *) data;
- dev_id = get_unaligned_le16(&cp->index);
- hdev = hci_dev_get(dev_id);
- if (!hdev)
- return cmd_status(sk, MGMT_OP_SET_IO_CAPABILITY, ENODEV);
- hci_dev_lock_bh(hdev);
- hdev->io_capability = cp->io_capability;
- BT_DBG("%s IO capability set to 0x%02x", hdev->name,
- hdev->io_capability);
- hci_dev_unlock_bh(hdev);
- hci_dev_put(hdev);
- return cmd_complete(sk, MGMT_OP_SET_IO_CAPABILITY,
- &dev_id, sizeof(dev_id));
- }
- static inline struct pending_cmd *find_pairing(struct hci_conn *conn)
- {
- struct hci_dev *hdev = conn->hdev;
- struct list_head *p;
- list_for_each(p, &cmd_list) {
- struct pending_cmd *cmd;
- cmd = list_entry(p, struct pending_cmd, list);
- if (cmd->opcode != MGMT_OP_PAIR_DEVICE)
- continue;
- if (cmd->index != hdev->id)
- continue;
- if (cmd->user_data != conn)
- continue;
- return cmd;
- }
- return NULL;
- }
- static void pairing_complete(struct pending_cmd *cmd, u8 status)
- {
- struct mgmt_rp_pair_device rp;
- struct hci_conn *conn = cmd->user_data;
- rp.index = cmd->index;
- bacpy(&rp.bdaddr, &conn->dst);
- rp.status = status;
- cmd_complete(cmd->sk, MGMT_OP_PAIR_DEVICE, &rp, sizeof(rp));
- /* So we don't get further callbacks for this connection */
- conn->connect_cfm_cb = NULL;
- conn->security_cfm_cb = NULL;
- conn->disconn_cfm_cb = NULL;
- hci_conn_put(conn);
- list_del(&cmd->list);
- mgmt_pending_free(cmd);
- }
- static void pairing_complete_cb(struct hci_conn *conn, u8 status)
- {
- struct pending_cmd *cmd;
- BT_DBG("status %u", status);
- cmd = find_pairing(conn);
- if (!cmd) {
- BT_DBG("Unable to find a pending command");
- return;
- }
- pairing_complete(cmd, status);
- }
- static int pair_device(struct sock *sk, unsigned char *data, u16 len)
- {
- struct hci_dev *hdev;
- struct mgmt_cp_pair_device *cp;
- struct pending_cmd *cmd;
- u8 sec_level, auth_type;
- struct hci_conn *conn;
- u16 dev_id;
- int err;
- BT_DBG("");
- cp = (void *) data;
- dev_id = get_unaligned_le16(&cp->index);
- hdev = hci_dev_get(dev_id);
- if (!hdev)
- return cmd_status(sk, MGMT_OP_PAIR_DEVICE, ENODEV);
- hci_dev_lock_bh(hdev);
- if (cp->io_cap == 0x03) {
- sec_level = BT_SECURITY_MEDIUM;
- auth_type = HCI_AT_DEDICATED_BONDING;
- } else {
- sec_level = BT_SECURITY_HIGH;
- auth_type = HCI_AT_DEDICATED_BONDING_MITM;
- }
- conn = hci_connect(hdev, ACL_LINK, &cp->bdaddr, sec_level, auth_type);
- if (!conn) {
- err = -ENOMEM;
- goto unlock;
- }
- if (conn->connect_cfm_cb) {
- hci_conn_put(conn);
- err = cmd_status(sk, MGMT_OP_PAIR_DEVICE, EBUSY);
- goto unlock;
- }
- cmd = mgmt_pending_add(sk, MGMT_OP_PAIR_DEVICE, dev_id, data, len);
- if (!cmd) {
- err = -ENOMEM;
- hci_conn_put(conn);
- goto unlock;
- }
- conn->connect_cfm_cb = pairing_complete_cb;
- conn->security_cfm_cb = pairing_complete_cb;
- conn->disconn_cfm_cb = pairing_complete_cb;
- conn->io_capability = cp->io_cap;
- cmd->user_data = conn;
- if (conn->state == BT_CONNECTED &&
- hci_conn_security(conn, sec_level, auth_type))
- pairing_complete(cmd, 0);
- err = 0;
- unlock:
- hci_dev_unlock_bh(hdev);
- hci_dev_put(hdev);
- return err;
- }
- static int user_confirm_reply(struct sock *sk, unsigned char *data, u16 len,
- int success)
- {
- struct mgmt_cp_user_confirm_reply *cp = (void *) data;
- u16 dev_id, mgmt_op, hci_op;
- struct pending_cmd *cmd;
- struct hci_dev *hdev;
- int err;
- BT_DBG("");
- dev_id = get_unaligned_le16(&cp->index);
- if (success) {
- mgmt_op = MGMT_OP_USER_CONFIRM_REPLY;
- hci_op = HCI_OP_USER_CONFIRM_REPLY;
- } else {
- mgmt_op = MGMT_OP_USER_CONFIRM_NEG_REPLY;
- hci_op = HCI_OP_USER_CONFIRM_NEG_REPLY;
- }
- hdev = hci_dev_get(dev_id);
- if (!hdev)
- return cmd_status(sk, mgmt_op, ENODEV);
- if (!test_bit(HCI_UP, &hdev->flags)) {
- err = cmd_status(sk, mgmt_op, ENETDOWN);
- goto failed;
- }
- cmd = mgmt_pending_add(sk, mgmt_op, dev_id, data, len);
- if (!cmd) {
- err = -ENOMEM;
- goto failed;
- }
- err = hci_send_cmd(hdev, hci_op, sizeof(cp->bdaddr), &cp->bdaddr);
- if (err < 0) {
- list_del(&cmd->list);
- mgmt_pending_free(cmd);
- }
- failed:
- hci_dev_unlock_bh(hdev);
- hci_dev_put(hdev);
- return err;
- }
- int mgmt_control(struct sock *sk, struct msghdr *msg, size_t msglen)
- {
- unsigned char *buf;
- struct mgmt_hdr *hdr;
- u16 opcode, len;
- int err;
- BT_DBG("got %zu bytes", msglen);
- if (msglen < sizeof(*hdr))
- return -EINVAL;
- buf = kmalloc(msglen, GFP_ATOMIC);
- if (!buf)
- return -ENOMEM;
- if (memcpy_fromiovec(buf, msg->msg_iov, msglen)) {
- err = -EFAULT;
- goto done;
- }
- hdr = (struct mgmt_hdr *) buf;
- opcode = get_unaligned_le16(&hdr->opcode);
- len = get_unaligned_le16(&hdr->len);
- if (len != msglen - sizeof(*hdr)) {
- err = -EINVAL;
- goto done;
- }
- switch (opcode) {
- case MGMT_OP_READ_VERSION:
- err = read_version(sk);
- break;
- case MGMT_OP_READ_INDEX_LIST:
- err = read_index_list(sk);
- break;
- case MGMT_OP_READ_INFO:
- err = read_controller_info(sk, buf + sizeof(*hdr), len);
- break;
- case MGMT_OP_SET_POWERED:
- err = set_powered(sk, buf + sizeof(*hdr), len);
- break;
- case MGMT_OP_SET_DISCOVERABLE:
- err = set_discoverable(sk, buf + sizeof(*hdr), len);
- break;
- case MGMT_OP_SET_CONNECTABLE:
- err = set_connectable(sk, buf + sizeof(*hdr), len);
- break;
- case MGMT_OP_SET_PAIRABLE:
- err = set_pairable(sk, buf + sizeof(*hdr), len);
- break;
- case MGMT_OP_ADD_UUID:
- err = add_uuid(sk, buf + sizeof(*hdr), len);
- break;
- case MGMT_OP_REMOVE_UUID:
- err = remove_uuid(sk, buf + sizeof(*hdr), len);
- break;
- case MGMT_OP_SET_DEV_CLASS:
- err = set_dev_class(sk, buf + sizeof(*hdr), len);
- break;
- case MGMT_OP_SET_SERVICE_CACHE:
- err = set_service_cache(sk, buf + sizeof(*hdr), len);
- break;
- case MGMT_OP_LOAD_KEYS:
- err = load_keys(sk, buf + sizeof(*hdr), len);
- break;
- case MGMT_OP_REMOVE_KEY:
- err = remove_key(sk, buf + sizeof(*hdr), len);
- break;
- case MGMT_OP_DISCONNECT:
- err = disconnect(sk, buf + sizeof(*hdr), len);
- break;
- case MGMT_OP_GET_CONNECTIONS:
- err = get_connections(sk, buf + sizeof(*hdr), len);
- break;
- case MGMT_OP_PIN_CODE_REPLY:
- err = pin_code_reply(sk, buf + sizeof(*hdr), len);
- break;
- case MGMT_OP_PIN_CODE_NEG_REPLY:
- err = pin_code_neg_reply(sk, buf + sizeof(*hdr), len);
- break;
- case MGMT_OP_SET_IO_CAPABILITY:
- err = set_io_capability(sk, buf + sizeof(*hdr), len);
- break;
- case MGMT_OP_PAIR_DEVICE:
- err = pair_device(sk, buf + sizeof(*hdr), len);
- break;
- case MGMT_OP_USER_CONFIRM_REPLY:
- err = user_confirm_reply(sk, buf + sizeof(*hdr), len, 1);
- break;
- case MGMT_OP_USER_CONFIRM_NEG_REPLY:
- err = user_confirm_reply(sk, buf + sizeof(*hdr), len, 0);
- break;
- default:
- BT_DBG("Unknown op %u", opcode);
- err = cmd_status(sk, opcode, 0x01);
- break;
- }
- if (err < 0)
- goto done;
- err = msglen;
- done:
- kfree(buf);
- return err;
- }
- int mgmt_index_added(u16 index)
- {
- struct mgmt_ev_index_added ev;
- put_unaligned_le16(index, &ev.index);
- return mgmt_event(MGMT_EV_INDEX_ADDED, &ev, sizeof(ev), NULL);
- }
- int mgmt_index_removed(u16 index)
- {
- struct mgmt_ev_index_added ev;
- put_unaligned_le16(index, &ev.index);
- return mgmt_event(MGMT_EV_INDEX_REMOVED, &ev, sizeof(ev), NULL);
- }
- struct cmd_lookup {
- u8 val;
- struct sock *sk;
- };
- static void mode_rsp(struct pending_cmd *cmd, void *data)
- {
- struct mgmt_mode *cp = cmd->cmd;
- struct cmd_lookup *match = data;
- if (cp->val != match->val)
- return;
- send_mode_rsp(cmd->sk, cmd->opcode, cmd->index, cp->val);
- list_del(&cmd->list);
- if (match->sk == NULL) {
- match->sk = cmd->sk;
- sock_hold(match->sk);
- }
- mgmt_pending_free(cmd);
- }
- int mgmt_powered(u16 index, u8 powered)
- {
- struct mgmt_mode ev;
- struct cmd_lookup match = { powered, NULL };
- int ret;
- mgmt_pending_foreach(MGMT_OP_SET_POWERED, index, mode_rsp, &match);
- put_unaligned_le16(index, &ev.index);
- ev.val = powered;
- ret = mgmt_event(MGMT_EV_POWERED, &ev, sizeof(ev), match.sk);
- if (match.sk)
- sock_put(match.sk);
- return ret;
- }
- int mgmt_discoverable(u16 index, u8 discoverable)
- {
- struct mgmt_mode ev;
- struct cmd_lookup match = { discoverable, NULL };
- int ret;
- mgmt_pending_foreach(MGMT_OP_SET_DISCOVERABLE, index,
- mode_rsp, &match);
- put_unaligned_le16(index, &ev.index);
- ev.val = discoverable;
- ret = mgmt_event(MGMT_EV_DISCOVERABLE, &ev, sizeof(ev), match.sk);
- if (match.sk)
- sock_put(match.sk);
- return ret;
- }
- int mgmt_connectable(u16 index, u8 connectable)
- {
- struct mgmt_mode ev;
- struct cmd_lookup match = { connectable, NULL };
- int ret;
- mgmt_pending_foreach(MGMT_OP_SET_CONNECTABLE, index, mode_rsp, &match);
- put_unaligned_le16(index, &ev.index);
- ev.val = connectable;
- ret = mgmt_event(MGMT_EV_CONNECTABLE, &ev, sizeof(ev), match.sk);
- if (match.sk)
- sock_put(match.sk);
- return ret;
- }
- int mgmt_new_key(u16 index, struct link_key *key, u8 old_key_type)
- {
- struct mgmt_ev_new_key ev;
- memset(&ev, 0, sizeof(ev));
- put_unaligned_le16(index, &ev.index);
- bacpy(&ev.key.bdaddr, &key->bdaddr);
- ev.key.type = key->type;
- memcpy(ev.key.val, key->val, 16);
- ev.key.pin_len = key->pin_len;
- ev.old_key_type = old_key_type;
- return mgmt_event(MGMT_EV_NEW_KEY, &ev, sizeof(ev), NULL);
- }
- int mgmt_connected(u16 index, bdaddr_t *bdaddr)
- {
- struct mgmt_ev_connected ev;
- put_unaligned_le16(index, &ev.index);
- bacpy(&ev.bdaddr, bdaddr);
- return mgmt_event(MGMT_EV_CONNECTED, &ev, sizeof(ev), NULL);
- }
- static void disconnect_rsp(struct pending_cmd *cmd, void *data)
- {
- struct mgmt_cp_disconnect *cp = cmd->cmd;
- struct sock **sk = data;
- struct mgmt_rp_disconnect rp;
- put_unaligned_le16(cmd->index, &rp.index);
- bacpy(&rp.bdaddr, &cp->bdaddr);
- cmd_complete(cmd->sk, MGMT_OP_DISCONNECT, &rp, sizeof(rp));
- *sk = cmd->sk;
- sock_hold(*sk);
- list_del(&cmd->list);
- mgmt_pending_free(cmd);
- }
- int mgmt_disconnected(u16 index, bdaddr_t *bdaddr)
- {
- struct mgmt_ev_disconnected ev;
- struct sock *sk = NULL;
- int err;
- mgmt_pending_foreach(MGMT_OP_DISCONNECT, index, disconnect_rsp, &sk);
- put_unaligned_le16(index, &ev.index);
- bacpy(&ev.bdaddr, bdaddr);
- err = mgmt_event(MGMT_EV_DISCONNECTED, &ev, sizeof(ev), sk);
- if (sk)
- sock_put(sk);
- return err;
- }
- int mgmt_disconnect_failed(u16 index)
- {
- struct pending_cmd *cmd;
- int err;
- cmd = mgmt_pending_find(MGMT_OP_DISCONNECT, index);
- if (!cmd)
- return -ENOENT;
- err = cmd_status(cmd->sk, MGMT_OP_DISCONNECT, EIO);
- list_del(&cmd->list);
- mgmt_pending_free(cmd);
- return err;
- }
- int mgmt_connect_failed(u16 index, bdaddr_t *bdaddr, u8 status)
- {
- struct mgmt_ev_connect_failed ev;
- put_unaligned_le16(index, &ev.index);
- bacpy(&ev.bdaddr, bdaddr);
- ev.status = status;
- return mgmt_event(MGMT_EV_CONNECT_FAILED, &ev, sizeof(ev), NULL);
- }
- int mgmt_pin_code_request(u16 index, bdaddr_t *bdaddr)
- {
- struct mgmt_ev_pin_code_request ev;
- put_unaligned_le16(index, &ev.index);
- bacpy(&ev.bdaddr, bdaddr);
- return mgmt_event(MGMT_EV_PIN_CODE_REQUEST, &ev, sizeof(ev), NULL);
- }
- int mgmt_pin_code_reply_complete(u16 index, bdaddr_t *bdaddr, u8 status)
- {
- struct pending_cmd *cmd;
- int err;
- cmd = mgmt_pending_find(MGMT_OP_PIN_CODE_REPLY, index);
- if (!cmd)
- return -ENOENT;
- if (status != 0)
- err = cmd_status(cmd->sk, MGMT_OP_PIN_CODE_REPLY, status);
- else
- err = cmd_complete(cmd->sk, MGMT_OP_PIN_CODE_REPLY,
- bdaddr, sizeof(*bdaddr));
- list_del(&cmd->list);
- mgmt_pending_free(cmd);
- return err;
- }
- int mgmt_pin_code_neg_reply_complete(u16 index, bdaddr_t *bdaddr, u8 status)
- {
- struct pending_cmd *cmd;
- int err;
- cmd = mgmt_pending_find(MGMT_OP_PIN_CODE_NEG_REPLY, index);
- if (!cmd)
- return -ENOENT;
- if (status != 0)
- err = cmd_status(cmd->sk, MGMT_OP_PIN_CODE_NEG_REPLY, status);
- else
- err = cmd_complete(cmd->sk, MGMT_OP_PIN_CODE_NEG_REPLY,
- bdaddr, sizeof(*bdaddr));
- list_del(&cmd->list);
- mgmt_pending_free(cmd);
- return err;
- }
- int mgmt_user_confirm_request(u16 index, bdaddr_t *bdaddr, __le32 value)
- {
- struct mgmt_ev_user_confirm_request ev;
- BT_DBG("hci%u", index);
- put_unaligned_le16(index, &ev.index);
- bacpy(&ev.bdaddr, bdaddr);
- put_unaligned_le32(value, &ev.value);
- return mgmt_event(MGMT_EV_USER_CONFIRM_REQUEST, &ev, sizeof(ev), NULL);
- }
- static int confirm_reply_complete(u16 index, bdaddr_t *bdaddr, u8 status,
- u8 opcode)
- {
- struct pending_cmd *cmd;
- struct mgmt_rp_user_confirm_reply rp;
- int err;
- cmd = mgmt_pending_find(opcode, index);
- if (!cmd)
- return -ENOENT;
- put_unaligned_le16(index, &rp.index);
- bacpy(&rp.bdaddr, bdaddr);
- rp.status = status;
- err = cmd_complete(cmd->sk, opcode, &rp, sizeof(rp));
- list_del(&cmd->list);
- mgmt_pending_free(cmd);
- return err;
- }
- int mgmt_user_confirm_reply_complete(u16 index, bdaddr_t *bdaddr, u8 status)
- {
- return confirm_reply_complete(index, bdaddr, status,
- MGMT_OP_USER_CONFIRM_REPLY);
- }
- int mgmt_user_confirm_neg_reply_complete(u16 index, bdaddr_t *bdaddr,
- u8 status)
- {
- return confirm_reply_complete(index, bdaddr, status,
- MGMT_OP_USER_CONFIRM_NEG_REPLY);
- }
|