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
  33 void 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 }
  42 EXPORT_SYMBOL(baswap);
  43
  44 /* Bluetooth error codes to Unix errno mapping */
  45 int 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 }
 136 EXPORT_SYMBOL(bt_to_errno);
 137
 138 /* Unix errno to Bluetooth error codes mapping */
 139 __u8 bt_status(int err)
 140 {
 141         /* Don't convert if already positive value */
 142         if (err >= 0)
 143                 return err;
 144
 145         switch (err) {
 146         case -EBADRQC:
 147                 return 0x01;
 148
 149         case -ENOTCONN:
 150                 return 0x02;
 151
 152         case -EIO:
 153                 return 0x03;
 154
 155         case -EHOSTDOWN:
 156                 return 0x04;
 157
 158         case -EACCES:
 159                 return 0x05;
 160
 161         case -EBADE:
 162                 return 0x06;
 163
 164         case -ENOMEM:
 165                 return 0x07;
 166
 167         case -ETIMEDOUT:
 168                 return 0x08;
 169
 170         case -EMLINK:
 171                 return 0x09;
 172
 173         case EALREADY:
 174                 return 0x0b;
 175
 176         case -EBUSY:
 177                 return 0x0c;
 178
 179         case -ECONNREFUSED:
 180                 return 0x0d;
 181
 182         case -EOPNOTSUPP:
 183                 return 0x11;
 184
 185         case -EINVAL:
 186                 return 0x12;
 187
 188         case -ECONNRESET:
 189                 return 0x13;
 190
 191         case -ECONNABORTED:
 192                 return 0x16;
 193
 194         case ELOOP:
 195                 return 0x17;
 196
 197         case -EPROTONOSUPPORT:
 198                 return 0x1a;
 199
 200         case -EPROTO:
 201                 return 0x19;
 202
 203         default:
 204                 return 0x1f;
 205         }
 206 }
 207 EXPORT_SYMBOL(bt_status);
 208
 209 void bt_info(const char *format, ...)
 210 {
 211         struct va_format vaf;
 212         va_list args;
 213
 214         va_start(args, format);
 215
 216         vaf.fmt = format;
 217         vaf.va = &args;
 218
 219         pr_info("%pV", &vaf);
 220
 221         va_end(args);
 222 }
 223 EXPORT_SYMBOL(bt_info);
 224
 225 void bt_warn(const char *format, ...)
 226 {
 227         struct va_format vaf;
 228         va_list args;
 229
 230         va_start(args, format);
 231
 232         vaf.fmt = format;
 233         vaf.va = &args;
 234
 235         pr_warn("%pV", &vaf);
 236
 237         va_end(args);
 238 }
 239 EXPORT_SYMBOL(bt_warn);
 240
 241 void bt_err(const char *format, ...)
 242 {
 243         struct va_format vaf;
 244         va_list args;
 245
 246         va_start(args, format);
 247
 248         vaf.fmt = format;
 249         vaf.va = &args;
 250
 251         pr_err("%pV", &vaf);
 252
 253         va_end(args);
 254 }
 255 EXPORT_SYMBOL(bt_err);
 256
 257 #ifdef CONFIG_BT_FEATURE_DEBUG
 258 static bool debug_enable;
 259
 260 void bt_dbg_set(bool enable)
 261 {
 262         debug_enable = enable;
 263 }
 264
 265 bool bt_dbg_get(void)
 266 {
 267         return debug_enable;
 268 }
 269
 270 void bt_dbg(const char *format, ...)
 271 {
 272         struct va_format vaf;
 273         va_list args;
 274
 275         if (likely(!debug_enable))
 276                 return;
 277
 278         va_start(args, format);
 279
 280         vaf.fmt = format;
 281         vaf.va = &args;
 282
 283         printk(KERN_DEBUG pr_fmt("%pV"), &vaf);
 284
 285         va_end(args);
 286 }
 287 EXPORT_SYMBOL(bt_dbg);
 288 #endif
 289
 290 void bt_warn_ratelimited(const char *format, ...)
 291 {
 292         struct va_format vaf;
 293         va_list args;
 294
 295         va_start(args, format);
 296
 297         vaf.fmt = format;
 298         vaf.va = &args;
 299
 300         pr_warn_ratelimited("%pV", &vaf);
 301
 302         va_end(args);
 303 }
 304 EXPORT_SYMBOL(bt_warn_ratelimited);
 305
 306 void bt_err_ratelimited(const char *format, ...)
 307 {
 308         struct va_format vaf;
 309         va_list args;
 310
 311         va_start(args, format);
 312
 313         vaf.fmt = format;
 314         vaf.va = &args;
 315
 316         pr_err_ratelimited("%pV", &vaf);
 317
 318         va_end(args);
 319 }
 320 EXPORT_SYMBOL(bt_err_ratelimited);