13deb3ec6SMatthias Ringwald /* 23deb3ec6SMatthias Ringwald * Copyright (C) 2014 BlueKitchen GmbH 33deb3ec6SMatthias Ringwald * 43deb3ec6SMatthias Ringwald * Redistribution and use in source and binary forms, with or without 53deb3ec6SMatthias Ringwald * modification, are permitted provided that the following conditions 63deb3ec6SMatthias Ringwald * are met: 73deb3ec6SMatthias Ringwald * 83deb3ec6SMatthias Ringwald * 1. Redistributions of source code must retain the above copyright 93deb3ec6SMatthias Ringwald * notice, this list of conditions and the following disclaimer. 103deb3ec6SMatthias Ringwald * 2. Redistributions in binary form must reproduce the above copyright 113deb3ec6SMatthias Ringwald * notice, this list of conditions and the following disclaimer in the 123deb3ec6SMatthias Ringwald * documentation and/or other materials provided with the distribution. 133deb3ec6SMatthias Ringwald * 3. Neither the name of the copyright holders nor the names of 143deb3ec6SMatthias Ringwald * contributors may be used to endorse or promote products derived 153deb3ec6SMatthias Ringwald * from this software without specific prior written permission. 163deb3ec6SMatthias Ringwald * 4. Any redistribution, use, or modification is done solely for 173deb3ec6SMatthias Ringwald * personal benefit and not for any commercial purpose or for 183deb3ec6SMatthias Ringwald * monetary gain. 193deb3ec6SMatthias Ringwald * 203deb3ec6SMatthias Ringwald * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS 213deb3ec6SMatthias Ringwald * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 223deb3ec6SMatthias Ringwald * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 233deb3ec6SMatthias Ringwald * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS 243deb3ec6SMatthias Ringwald * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 253deb3ec6SMatthias Ringwald * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 263deb3ec6SMatthias Ringwald * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 273deb3ec6SMatthias Ringwald * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 283deb3ec6SMatthias Ringwald * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 293deb3ec6SMatthias Ringwald * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 303deb3ec6SMatthias Ringwald * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 313deb3ec6SMatthias Ringwald * SUCH DAMAGE. 323deb3ec6SMatthias Ringwald * 333deb3ec6SMatthias Ringwald * Please inquire about commercial licensing options at 343deb3ec6SMatthias Ringwald * [email protected] 353deb3ec6SMatthias Ringwald * 363deb3ec6SMatthias Ringwald */ 373deb3ec6SMatthias Ringwald 38ab2c6ae4SMatthias Ringwald #define __BTSTACK_FILE__ "att_dispatch.c" 39ab2c6ae4SMatthias Ringwald 403deb3ec6SMatthias Ringwald 413deb3ec6SMatthias Ringwald /** 423deb3ec6SMatthias Ringwald * Dispatcher for independent implementation of ATT client and server 433deb3ec6SMatthias Ringwald */ 443deb3ec6SMatthias Ringwald 453deb3ec6SMatthias Ringwald #include "att_dispatch.h" 4659c6af15SMatthias Ringwald #include "ble/core.h" 4716ece135SMatthias Ringwald #include "btstack_debug.h" 4859c6af15SMatthias Ringwald #include "l2cap.h" 493deb3ec6SMatthias Ringwald 5019448c0bSMatthias Ringwald static btstack_packet_handler_t att_client_handler; 5119448c0bSMatthias Ringwald static btstack_packet_handler_t att_server_handler; 52773c4106SMatthias Ringwald 53773c4106SMatthias Ringwald static uint8_t att_client_waiting_for_can_send; 54773c4106SMatthias Ringwald static uint8_t att_server_waiting_for_can_send; 553deb3ec6SMatthias Ringwald 563deb3ec6SMatthias Ringwald static void att_packet_handler(uint8_t packet_type, uint16_t handle, uint8_t *packet, uint16_t size){ 57773c4106SMatthias Ringwald switch (packet_type){ 58773c4106SMatthias Ringwald case ATT_DATA_PACKET: 593deb3ec6SMatthias Ringwald // log_info("att_data_packet with opcode 0x%x", packet[0]); 60773c4106SMatthias Ringwald if (packet[0] & 1){ 613deb3ec6SMatthias Ringwald // odd PDUs are sent from server to client 6219448c0bSMatthias Ringwald if (!att_client_handler) return; 633deb3ec6SMatthias Ringwald att_client_handler(packet_type, handle, packet, size); 643deb3ec6SMatthias Ringwald } else { 653deb3ec6SMatthias Ringwald // even PDUs are sent from client to server 6619448c0bSMatthias Ringwald if (!att_server_handler) return; 673deb3ec6SMatthias Ringwald att_server_handler(packet_type, handle, packet, size); 683deb3ec6SMatthias Ringwald } 69202c8a4cSMatthias Ringwald break; 70773c4106SMatthias Ringwald case HCI_EVENT_PACKET: 71773c4106SMatthias Ringwald if (packet[0] != L2CAP_EVENT_CAN_SEND_NOW) break; 72773c4106SMatthias Ringwald if (att_server_handler && att_server_waiting_for_can_send){ 73773c4106SMatthias Ringwald att_server_waiting_for_can_send = 0; 74773c4106SMatthias Ringwald att_server_handler(packet_type, handle, packet, size); 75773c4106SMatthias Ringwald // stop if client cannot send anymore 76b947e684SMatthias Ringwald if (!hci_can_send_acl_le_packet_now()) break; 77773c4106SMatthias Ringwald } 78773c4106SMatthias Ringwald if (att_client_handler && att_client_waiting_for_can_send){ 79773c4106SMatthias Ringwald att_client_waiting_for_can_send = 0; 80773c4106SMatthias Ringwald att_client_handler(packet_type, handle, packet, size); 81773c4106SMatthias Ringwald } 82773c4106SMatthias Ringwald break; 83773c4106SMatthias Ringwald default: 84773c4106SMatthias Ringwald break; 85773c4106SMatthias Ringwald } 863deb3ec6SMatthias Ringwald } 873deb3ec6SMatthias Ringwald 883deb3ec6SMatthias Ringwald /** 893deb3ec6SMatthias Ringwald * @brief reset att dispatchter 903deb3ec6SMatthias Ringwald * @param packet_hander for ATT client packets 913deb3ec6SMatthias Ringwald */ 923deb3ec6SMatthias Ringwald void att_dispatch_register_client(btstack_packet_handler_t packet_handler){ 933deb3ec6SMatthias Ringwald att_client_handler = packet_handler; 943deb3ec6SMatthias Ringwald l2cap_register_fixed_channel(att_packet_handler, L2CAP_CID_ATTRIBUTE_PROTOCOL); 953deb3ec6SMatthias Ringwald } 963deb3ec6SMatthias Ringwald 973deb3ec6SMatthias Ringwald /** 983deb3ec6SMatthias Ringwald * @brief reset att dispatchter 993deb3ec6SMatthias Ringwald * @param packet_hander for ATT server packets 1003deb3ec6SMatthias Ringwald */ 1013deb3ec6SMatthias Ringwald void att_dispatch_register_server(btstack_packet_handler_t packet_handler){ 1023deb3ec6SMatthias Ringwald att_server_handler = packet_handler; 1033deb3ec6SMatthias Ringwald l2cap_register_fixed_channel(att_packet_handler, L2CAP_CID_ATTRIBUTE_PROTOCOL); 1043deb3ec6SMatthias Ringwald } 10519448c0bSMatthias Ringwald 10619448c0bSMatthias Ringwald /** 10719448c0bSMatthias Ringwald * @brief can send packet for client 10819448c0bSMatthias Ringwald * @param handle 10919448c0bSMatthias Ringwald */ 110fc64f94aSMatthias Ringwald int att_dispatch_client_can_send_now(hci_con_handle_t con_handle){ 1110b9d7e78SMatthias Ringwald return l2cap_can_send_fixed_channel_packet_now(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL); 11219448c0bSMatthias Ringwald } 11319448c0bSMatthias Ringwald 11419448c0bSMatthias Ringwald /** 11519448c0bSMatthias Ringwald * @brief can send packet for server 11619448c0bSMatthias Ringwald * @param handle 11719448c0bSMatthias Ringwald */ 118fc64f94aSMatthias Ringwald int att_dispatch_server_can_send_now(hci_con_handle_t con_handle){ 1190b9d7e78SMatthias Ringwald return l2cap_can_send_fixed_channel_packet_now(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL); 120773c4106SMatthias Ringwald } 1210b9d7e78SMatthias Ringwald 1220b9d7e78SMatthias Ringwald /** 1230b9d7e78SMatthias Ringwald * @brief Request emission of L2CAP_EVENT_CAN_SEND_NOW as soon as possible for client 1240b9d7e78SMatthias Ringwald * @note L2CAP_EVENT_CAN_SEND_NOW might be emitted during call to this function 1250b9d7e78SMatthias Ringwald * so packet handler should be ready to handle it 1260b9d7e78SMatthias Ringwald * @param con_handle 1270b9d7e78SMatthias Ringwald */ 1280b9d7e78SMatthias Ringwald void att_dispatch_client_request_can_send_now_event(hci_con_handle_t con_handle){ 1290b9d7e78SMatthias Ringwald att_client_waiting_for_can_send = 1; 1300b9d7e78SMatthias Ringwald l2cap_request_can_send_fix_channel_now_event(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL); 1310b9d7e78SMatthias Ringwald } 1320b9d7e78SMatthias Ringwald 1330b9d7e78SMatthias Ringwald /** 1340b9d7e78SMatthias Ringwald * @brief Request emission of L2CAP_EVENT_CAN_SEND_NOW as soon as possible for server 1350b9d7e78SMatthias Ringwald * @note L2CAP_EVENT_CAN_SEND_NOW might be emitted during call to this function 1360b9d7e78SMatthias Ringwald * so packet handler should be ready to handle it 1370b9d7e78SMatthias Ringwald * @param con_handle 1380b9d7e78SMatthias Ringwald */ 1390b9d7e78SMatthias Ringwald void att_dispatch_server_request_can_send_now_event(hci_con_handle_t con_handle){ 1400b9d7e78SMatthias Ringwald att_server_waiting_for_can_send = 1; 1410b9d7e78SMatthias Ringwald l2cap_request_can_send_fix_channel_now_event(con_handle, L2CAP_CID_ATTRIBUTE_PROTOCOL); 14219448c0bSMatthias Ringwald } 143b12646c5SJakob Krantz 144*25684bfcSMatthias Ringwald static void emit_mtu_exchange_complete(btstack_packet_handler_t packet_handler, hci_con_handle_t con_handle, uint16_t new_mtu){ 145*25684bfcSMatthias Ringwald if (!packet_handler) return; 146b12646c5SJakob Krantz uint8_t packet[6]; 147b12646c5SJakob Krantz packet[0] = ATT_EVENT_MTU_EXCHANGE_COMPLETE; 148b12646c5SJakob Krantz packet[1] = sizeof(packet) - 2; 149b12646c5SJakob Krantz little_endian_store_16(packet, 2, con_handle); 150b12646c5SJakob Krantz little_endian_store_16(packet, 4, new_mtu); 151*25684bfcSMatthias Ringwald packet_handler(HCI_EVENT_PACKET, con_handle, packet, 1); 152*25684bfcSMatthias Ringwald } 153*25684bfcSMatthias Ringwald 154*25684bfcSMatthias Ringwald void att_dispatch_server_mtu_exchanged(hci_con_handle_t con_handle, uint16_t new_mtu){ 155*25684bfcSMatthias Ringwald emit_mtu_exchange_complete(att_client_handler, con_handle, new_mtu); 156b12646c5SJakob Krantz } 157b12646c5SJakob Krantz 158b12646c5SJakob Krantz void att_dispatch_client_mtu_exchanged(hci_con_handle_t con_handle, uint16_t new_mtu){ 159*25684bfcSMatthias Ringwald emit_mtu_exchange_complete(att_server_handler, con_handle, new_mtu); 160b12646c5SJakob Krantz } 161