Return-Path: From: alokbarsode@gmail.com To: linux-bluetooth@vger.kernel.org Cc: marcel@holtmann.com, Alok Barsode Subject: [PATCH 3/3] Adding stop() functionality to hciops plugin. Date: Mon, 4 May 2009 20:38:14 +0530 Message-Id: <1241449694-17135-3-git-send-email-alok.barsode@azingo.com> In-Reply-To: <1241449694-17135-2-git-send-email-alok.barsode@azingo.com> References: <1241449694-17135-1-git-send-email-alok.barsode@azingo.com> <1241449694-17135-2-git-send-email-alok.barsode@azingo.com> Sender: linux-bluetooth-owner@vger.kernel.org List-ID: From: Alok Barsode --- plugins/hciops.c | 24 ++++++++++++++++++++++++ src/adapter.c | 25 ++++++++++++++----------- src/adapter.h | 1 + 3 files changed, 39 insertions(+), 11 deletions(-) diff --git a/plugins/hciops.c b/plugins/hciops.c index ba4b69d..2e91129 100644 --- a/plugins/hciops.c +++ b/plugins/hciops.c @@ -439,10 +439,34 @@ done: return err; } +static int hciops_stop(int index) +{ + int dd; + int err = 0; + + dd = hci_open_dev(index); + if (dd < 0) + return -EIO; + + if (ioctl(dd, HCIDEVDOWN, index) == 0) + goto done; /* on success */ + + if (errno != EALREADY) { + err = -errno; + error("Can't stop device hci%d: %s (%d)", + index, strerror(errno), errno); + } + +done: + hci_close_dev(dd); + return err; +} + static struct btd_adapter_ops hci_ops = { .setup = hciops_setup, .cleanup = hciops_cleanup, .start = hciops_start, + .stop = hciops_stop, }; static int hciops_init(void) diff --git a/src/adapter.c b/src/adapter.c index 2135795..007702a 100644 --- a/src/adapter.c +++ b/src/adapter.c @@ -426,11 +426,12 @@ static int set_mode(struct btd_adapter *adapter, uint8_t new_mode) }; hci_send_req(dd, &rq, HCI_REQ_TIMEOUT); + hci_close_dev(dd); - if (ioctl(dd, HCIDEVDOWN, adapter->dev_id) < 0) { - err = -errno; - hci_close_dev(dd); - return err; + if (adapter_ops) { + err = adapter_ops->stop(adapter->dev_id); + if (err < 0) + return err; } adapter->off_requested = TRUE; @@ -438,6 +439,10 @@ static int set_mode(struct btd_adapter *adapter, uint8_t new_mode) goto done; } + dd = hci_open_dev(adapter->dev_id); + if (dd < 0) + return -EIO; + if (current_scan != scan_enable) { err = hci_send_cmd(dd, OGF_HOST_CTL, OCF_WRITE_SCAN_ENABLE, 1, &scan_enable); @@ -2085,7 +2090,9 @@ proceed: } if (dev_down) { - ioctl(dd, HCIDEVDOWN, adapter->dev_id); + if (adapter_ops) + adapter_ops->stop(adapter->dev_id); + adapter->off_requested = TRUE; return 1; } else @@ -2469,12 +2476,8 @@ void adapter_remove(struct btd_adapter *adapter) /* Return adapter to down state if it was not up on init */ if (adapter->up && !adapter->already_up) { - int dd = hci_open_dev(adapter->dev_id); - if (dd < 0) - goto done; - - ioctl(dd, HCIDEVDOWN, adapter->dev_id); - hci_close_dev(dd); + if (adapter_ops) + adapter_ops->stop(adapter->dev_id); } done: diff --git a/src/adapter.h b/src/adapter.h index 67db648..acf680b 100644 --- a/src/adapter.h +++ b/src/adapter.h @@ -153,6 +153,7 @@ struct btd_adapter_ops { int (*setup) (void); void (*cleanup) (void); int (*start) (int index); + int (*stop) (int index); }; int btd_register_adapter_ops(struct btd_adapter_ops *btd_adapter_ops); -- 1.5.6.3