forked from Minki/linux
Bluetooth: Add initial sleep support to Three-wire UART
This patch adds very basic support for the sleep related messages. The only thing the code does right now is send a wakeup message as soon as receiving a sleep one, essentially preventing the controller from going to sleep. Signed-off-by: Johan Hedberg <johan.hedberg@intel.com> Signed-off-by: Gustavo Padovan <gustavo.padovan@collabora.co.uk>
This commit is contained in:
parent
255a68e012
commit
10122d07ce
@ -74,6 +74,8 @@ struct h5 {
|
||||
bool tx_ack_req; /* Pending ack to send */
|
||||
u8 tx_seq; /* Next seq number to send */
|
||||
u8 tx_ack; /* Next ack number to send */
|
||||
|
||||
bool sleeping;
|
||||
};
|
||||
|
||||
static void h5_reset_rx(struct h5 *h5);
|
||||
@ -211,6 +213,9 @@ static void h5_handle_internal_rx(struct hci_uart *hu)
|
||||
const unsigned char sync_rsp[] = { 0x02, 0x7d };
|
||||
const unsigned char conf_req[] = { 0x03, 0xfc, 0x01 };
|
||||
const unsigned char conf_rsp[] = { 0x04, 0x7b, 0x01 };
|
||||
const unsigned char wakeup_req[] = { 0x05, 0xfa };
|
||||
const unsigned char woken_req[] = { 0x06, 0xf9 };
|
||||
const unsigned char sleep_req[] = { 0x07, 0x78 };
|
||||
const unsigned char *hdr = h5->rx_skb->data;
|
||||
const unsigned char *data = &h5->rx_skb->data[4];
|
||||
|
||||
@ -233,6 +238,14 @@ static void h5_handle_internal_rx(struct hci_uart *hu)
|
||||
BT_DBG("Three-wire init sequence complete");
|
||||
hci_uart_init_ready(hu);
|
||||
return;
|
||||
} else if (memcmp(data, sleep_req, 2) == 0) {
|
||||
BT_DBG("Peer went to sleep");
|
||||
h5->sleeping = true;
|
||||
h5_link_control(hu, wakeup_req, 2);
|
||||
} else if (memcmp(data, woken_req, 2) == 0) {
|
||||
BT_DBG("Peer woke up");
|
||||
h5->sleeping = false;
|
||||
return;
|
||||
} else {
|
||||
BT_DBG("Link Control: 0x%02hhx 0x%02hhx", data[0], data[1]);
|
||||
return;
|
||||
|
Loading…
Reference in New Issue
Block a user