LXR linux/net/bluetooth/lib.c

   1/*
   2   BlueZ - Bluetooth protocol stack for Linux
   3   Copyright (C) 2000-2001 Qualcomm Incorporated
   4
   5   Written 2000,2001 by Maxim Krasnyansky <maxk@qualcomm.com>
   6
   7   This program is free software; you can redistribute it and/or modify
   8   it under the terms of the GNU General Public License version 2 as
   9   published by the Free Software Foundation;
  10
  11   THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
  12   OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  13   FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
  14   IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
  15   CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
  16   WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  17   ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  18   OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  19
  20   ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
  21   COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
  22   SOFTWARE IS DISCLAIMED.
  23*/
  24
  25/* Bluetooth kernel library. */
  26
  27#define pr_fmt(fmt) "Bluetooth: " fmt
  28
  29#include <linux/export.h>
  30
  31#include <net/bluetooth/bluetooth.h>
  32
  33void baswap(bdaddr_t *dst, const bdaddr_t *src)
  34{
  35        const unsigned char *s = (const unsigned char *)src;
  36        unsigned char *d = (unsigned char *)dst;
  37        unsigned int i;
  38
  39        for (i = 0; i < 6; i++)
  40                d[i] = s[5 - i];
  41}
  42EXPORT_SYMBOL(baswap);
  43
  44/* Bluetooth error codes to Unix errno mapping */
  45int bt_to_errno(__u16 code)
  46{
  47        switch (code) {
  48        case 0:
  49                return 0;
  50
  51        case 0x01:
  52                return EBADRQC;
  53
  54        case 0x02:
  55                return ENOTCONN;
  56
  57        case 0x03:
  58                return EIO;
  59
  60        case 0x04:
  61        case 0x3c:
  62                return EHOSTDOWN;
  63
  64        case 0x05:
  65                return EACCES;
  66
  67        case 0x06:
  68                return EBADE;
  69
  70        case 0x07:
  71                return ENOMEM;
  72
  73        case 0x08:
  74                return ETIMEDOUT;
  75
  76        case 0x09:
  77                return EMLINK;
  78
  79        case 0x0a:
  80                return EMLINK;
  81
  82        case 0x0b:
  83                return EALREADY;
  84
  85        case 0x0c:
  86                return EBUSY;
  87
  88        case 0x0d:
  89        case 0x0e:
  90        case 0x0f:
  91                return ECONNREFUSED;
  92
  93        case 0x10:
  94                return ETIMEDOUT;
  95
  96        case 0x11:
  97        case 0x27:
  98        case 0x29:
  99        case 0x20:
 100                return EOPNOTSUPP;
 101
 102        case 0x12:
 103                return EINVAL;
 104
 105        case 0x13:
 106        case 0x14:
 107        case 0x15:
 108                return ECONNRESET;
 109
 110        case 0x16:
 111                return ECONNABORTED;
 112
 113        case 0x17:
 114                return ELOOP;
 115
 116        case 0x18:
 117                return EACCES;
 118
 119        case 0x1a:
 120                return EPROTONOSUPPORT;
 121
 122        case 0x1b:
 123                return ECONNREFUSED;
 124
 125        case 0x19:
 126        case 0x1e:
 127        case 0x23:
 128        case 0x24:
 129        case 0x25:
 130                return EPROTO;
 131
 132        default:
 133                return ENOSYS;
 134        }
 135}
 136EXPORT_SYMBOL(bt_to_errno);
 137
 138void bt_info(const char *format, ...)
 139{
 140        struct va_format vaf;
 141        va_list args;
 142
 143        va_start(args, format);
 144
 145        vaf.fmt = format;
 146        vaf.va = &args;
 147
 148        pr_info("%pV", &vaf);
 149
 150        va_end(args);
 151}
 152EXPORT_SYMBOL(bt_info);
 153
 154void bt_warn(const char *format, ...)
 155{
 156        struct va_format vaf;
 157        va_list args;
 158
 159        va_start(args, format);
 160
 161        vaf.fmt = format;
 162        vaf.va = &args;
 163
 164        pr_warn("%pV", &vaf);
 165
 166        va_end(args);
 167}
 168EXPORT_SYMBOL(bt_warn);
 169
 170void bt_err(const char *format, ...)
 171{
 172        struct va_format vaf;
 173        va_list args;
 174
 175        va_start(args, format);
 176
 177        vaf.fmt = format;
 178        vaf.va = &args;
 179
 180        pr_err("%pV", &vaf);
 181
 182        va_end(args);
 183}
 184EXPORT_SYMBOL(bt_err);
 185
 186#ifdef CONFIG_BT_FEATURE_DEBUG
 187static bool debug_enable;
 188
 189void bt_dbg_set(bool enable)
 190{
 191        debug_enable = enable;
 192}
 193
 194bool bt_dbg_get(void)
 195{
 196        return debug_enable;
 197}
 198
 199void bt_dbg(const char *format, ...)
 200{
 201        struct va_format vaf;
 202        va_list args;
 203
 204        if (likely(!debug_enable))
 205                return;
 206
 207        va_start(args, format);
 208
 209        vaf.fmt = format;
 210        vaf.va = &args;
 211
 212        printk(KERN_DEBUG pr_fmt("%pV"), &vaf);
 213
 214        va_end(args);
 215}
 216EXPORT_SYMBOL(bt_dbg);
 217#endif
 218
 219void bt_warn_ratelimited(const char *format, ...)
 220{
 221        struct va_format vaf;
 222        va_list args;
 223
 224        va_start(args, format);
 225
 226        vaf.fmt = format;
 227        vaf.va = &args;
 228
 229        pr_warn_ratelimited("%pV", &vaf);
 230
 231        va_end(args);
 232}
 233EXPORT_SYMBOL(bt_warn_ratelimited);
 234
 235void bt_err_ratelimited(const char *format, ...)
 236{
 237        struct va_format vaf;
 238        va_list args;
 239
 240        va_start(args, format);
 241
 242        vaf.fmt = format;
 243        vaf.va = &args;
 244
 245        pr_err_ratelimited("%pV", &vaf);
 246
 247        va_end(args);
 248}
 249EXPORT_SYMBOL(bt_err_ratelimited);
 250