void btstack_libusb_device_base::send_acl_package( std::uint8_t* acl_buffer, std::size_t size ) { const int pb = hci_non_flushable_packet_boundary_flag_supported() ? 0x00 : 0x02; // 0 - Connection handle : PB=pb : BC=00 write_u16(acl_buffer + 0, connection_handle_ | (pb << 12) | (0 << 14)); write_u16(acl_buffer + 2, size - 4); write_u16(acl_buffer + 4, size - 8); // 6 - L2CAP channel = 1 write_u16(acl_buffer + 6, 0x0004); log_info("*send_acl_package: %i", size ); hexdump( acl_buffer, size ); hci_send_acl_packet_buffer( size ); }
uint16_t l2cap_create_signaling_internal(uint8_t * acl_buffer, hci_con_handle_t handle, uint16_t cid, L2CAP_SIGNALING_COMMANDS cmd, uint8_t identifier, va_list argptr){ const char *format = l2cap_signaling_commands_format[cmd-1]; uint16_t word; uint8_t * ptr; int pb = hci_non_flushable_packet_boundary_flag_supported() ? 0x00 : 0x02; // 0 - Connection handle : PB=pb : BC=00 bt_store_16(acl_buffer, 0, handle | (pb << 12) | (0 << 14)); // 6 - L2CAP channel = 1 bt_store_16(acl_buffer, 6, cid); // 8 - Code acl_buffer[8] = cmd; // 9 - id (!= 0 sequentially) acl_buffer[9] = identifier; // 12 - L2CAP signaling parameters uint16_t pos = 12; // skip AMP commands if (cmd >= CONNECTION_PARAMETER_UPDATE_REQUEST){ cmd -= 6; } while (*format) { switch(*format) { case '1': // 8 bit value case '2': // 16 bit value word = va_arg(argptr, int); // minimal va_arg is int: 2 bytes on 8+16 bit CPUs acl_buffer[pos++] = word & 0xff; if (*format == '2') { acl_buffer[pos++] = word >> 8; } break; case 'D': // variable data. passed: len, ptr word = va_arg(argptr, int); ptr = va_arg(argptr, uint8_t *); memcpy(&acl_buffer[pos], ptr, word); pos += word; break; default: break; } format++; };
int l2cap_send_connectionless(uint16_t handle, uint16_t cid, uint8_t * buffer, uint16_t len) { // printf("l2cap_send_connectionless\n"); int pb = hci_non_flushable_packet_boundary_flag_supported() ? 0x00 : 0x02; // 0 - Connection handle : PB=pb : BC=00 bt_store_16(packet_buffer, 0, handle | (pb << 12) | (0 << 14)); // 2 - ACL length bt_store_16(packet_buffer, 2, len + 4); // 4 - L2CAP packet length bt_store_16(packet_buffer, 4, len + 0); // 6 - L2CAP channel DEST bt_store_16(packet_buffer, 6, cid); memcpy(&packet_buffer[8], buffer, len); hci_dump_packet(HCI_ACL_DATA_PACKET, 0, &packet_buffer[0], len + 8); dump_packet(HCI_ACL_DATA_PACKET, packet_buffer, len + 8); packet_buffer_len = len + 8; return 0; }