From 10122d07ced378ec9187f4b3110e110282beb192 Mon Sep 17 00:00:00 2001 From: Johan Hedberg Date: Mon, 16 Jul 2012 16:12:14 +0300 Subject: [PATCH] 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 Signed-off-by: Gustavo Padovan --- drivers/bluetooth/hci_h5.c | 13 +++++++++++++ 1 file changed, 13 insertions(+) diff --git a/drivers/bluetooth/hci_h5.c b/drivers/bluetooth/hci_h5.c index eb40b9a38289..d9d42f65ee6e 100644 --- a/drivers/bluetooth/hci_h5.c +++ b/drivers/bluetooth/hci_h5.c @@ -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; -- 2.30.2