net/irda/irias_object.c

   1 /*********************************************************************
   2  *
   3  * Filename:      irias_object.c
   4  * Version:       0.3
   5  * Description:   IAS object database and functions
   6  * Status:        Experimental.
   7  * Author:        Dag Brattli <dagb@cs.uit.no>
   8  * Created at:    Thu Oct  1 22:50:04 1998
   9  * Modified at:   Sat Oct  9 17:11:16 1999
  10  * Modified by:   Dag Brattli <dagb@cs.uit.no>
  11  *
  12  *     Copyright (c) 1998-1999 Dag Brattli, All Rights Reserved.
  13  *
  14  *     This program is free software; you can redistribute it and/or
  15  *     modify it under the terms of the GNU General Public License as
  16  *     published by the Free Software Foundation; either version 2 of
  17  *     the License, or (at your option) any later version.
  18  *
  19  *     Neither Dag Brattli nor University of Tromsø admit liability nor
  20  *     provide warranty for any of this software. This material is
  21  *     provided "AS-IS" and at no charge.
  22  *
  23  ********************************************************************/
  24
  25 #include <linux/string.h>
  26 #include <linux/socket.h>
  27
  28 #include <net/irda/irda.h>
  29 #include <net/irda/irmod.h>
  30 #include <net/irda/irias_object.h>
  31
  32 hashbin_t *objects = NULL;
  33
  34 /*
  35  *  Used when a missing value needs to be returned
  36  */
  37 struct ias_value missing = { IAS_MISSING, 0, 0, {0}};
  38
  39 /*
  40  * Function strdup (str)
  41  *
  42  *    My own kernel version of strdup!
  43  *
  44  */
  45 char *strdup(char *str)
  46 {
  47         char *new_str;
  48
  49         if (str == NULL)
  50                 return NULL;
  51
  52         ASSERT(strlen( str) < 64, return NULL;);
  53
  54         new_str = kmalloc(strlen(str)+1, GFP_ATOMIC);
  55         if (new_str == NULL)
  56                 return NULL;
  57
  58         strcpy(new_str, str);
  59
  60         return new_str;
  61 }
  62
  63 /*
  64  * Function ias_new_object (name, id)
  65  *
  66  *    Create a new IAS object
  67  *
  68  */
  69 struct ias_object *irias_new_object( char *name, int id)
  70 {
  71         struct ias_object *obj;
  72
  73         IRDA_DEBUG( 4, __FUNCTION__ "()\n");
  74
  75         obj = (struct ias_object *) kmalloc( sizeof( struct ias_object),
  76                                              GFP_ATOMIC);
  77         if (obj == NULL) {
  78                 IRDA_DEBUG(0, __FUNCTION__ "(), Unable to allocate object!\n");
  79                 return NULL;
  80         }
  81         memset(obj, 0, sizeof( struct ias_object));
  82
  83         obj->magic = IAS_OBJECT_MAGIC;
  84         obj->name = strdup( name);
  85         obj->id = id;
  86
  87         obj->attribs = hashbin_new(HB_LOCAL);
  88
  89         return obj;
  90 }
  91
  92 /*
  93  * Function irias_delete_attrib (attrib)
  94  *
  95  *    Delete given attribute and deallocate all its memory
  96  *
  97  */
  98 void __irias_delete_attrib(struct ias_attrib *attrib)
  99 {
 100         ASSERT(attrib != NULL, return;);
 101         ASSERT(attrib->magic == IAS_ATTRIB_MAGIC, return;);
 102
 103         if (attrib->name)
 104                 kfree(attrib->name);
 105
 106         irias_delete_value(attrib->value);
 107         attrib->magic = ~IAS_ATTRIB_MAGIC;
 108
 109         kfree(attrib);
 110 }
 111
 112 void __irias_delete_object(struct ias_object *obj)
 113 {
 114         ASSERT(obj != NULL, return;);
 115         ASSERT(obj->magic == IAS_OBJECT_MAGIC, return;);
 116
 117         if (obj->name)
 118                 kfree(obj->name);
 119
 120         hashbin_delete(obj->attribs, (FREE_FUNC) __irias_delete_attrib);
 121
 122         obj->magic = ~IAS_OBJECT_MAGIC;
 123
 124         kfree(obj);
 125 }
 126
 127 /*
 128  * Function irias_delete_object (obj)
 129  *
 130  *    Remove object from hashbin and deallocate all attributes assosiated with
 131  *    with this object and the object itself
 132  *
 133  */
 134 int irias_delete_object(struct ias_object *obj)
 135 {
 136         struct ias_object *node;
 137
 138         ASSERT(obj != NULL, return -1;);
 139         ASSERT(obj->magic == IAS_OBJECT_MAGIC, return -1;);
 140
 141         node = hashbin_remove(objects, 0, obj->name);
 142         if (!node)
 143                 return 0; /* Already removed */
 144
 145         __irias_delete_object(node);
 146
 147         return 0;
 148 }
 149
 150 /*
 151  * Function irias_insert_object (obj)
 152  *
 153  *    Insert an object into the LM-IAS database
 154  *
 155  */
 156 void irias_insert_object(struct ias_object *obj)
 157 {
 158         ASSERT(obj != NULL, return;);
 159         ASSERT(obj->magic == IAS_OBJECT_MAGIC, return;);
 160
 161         hashbin_insert(objects, (queue_t *) obj, 0, obj->name);
 162 }
 163
 164 /*
 165  * Function irias_find_object (name)
 166  *
 167  *    Find object with given name
 168  *
 169  */
 170 struct ias_object *irias_find_object(char *name)
 171 {
 172         ASSERT(name != NULL, return NULL;);
 173
 174         return hashbin_find(objects, 0, name);
 175 }
 176
 177 /*
 178  * Function irias_find_attrib (obj, name)
 179  *
 180  *    Find named attribute in object
 181  *
 182  */
 183 struct ias_attrib *irias_find_attrib(struct ias_object *obj, char *name)
 184 {
 185         struct ias_attrib *attrib;
 186
 187         ASSERT(obj != NULL, return NULL;);
 188         ASSERT(obj->magic == IAS_OBJECT_MAGIC, return NULL;);
 189         ASSERT(name != NULL, return NULL;);
 190
 191         attrib = hashbin_find(obj->attribs, 0, name);
 192         if (attrib == NULL)
 193                 return NULL;
 194
 195         return attrib;
 196 }
 197
 198 /*
 199  * Function irias_add_attribute (obj, attrib)
 200  *
 201  *    Add attribute to object
 202  *
 203  */
 204 void irias_add_attrib( struct ias_object *obj, struct ias_attrib *attrib)
 205 {
 206         ASSERT(obj != NULL, return;);
 207         ASSERT(obj->magic == IAS_OBJECT_MAGIC, return;);
 208
 209         ASSERT(attrib != NULL, return;);
 210         ASSERT(attrib->magic == IAS_ATTRIB_MAGIC, return;);
 211
 212         hashbin_insert(obj->attribs, (queue_t *) attrib, 0, attrib->name);
 213 }
 214
 215 /*
 216  * Function irias_object_change_attribute (obj_name, attrib_name, new_value)
 217  *
 218  *    Change the value of an objects attribute.
 219  *
 220  */
 221 int irias_object_change_attribute(char *obj_name, char *attrib_name,
 222                                   struct ias_value *new_value)
 223 {
 224         struct ias_object *obj;
 225         struct ias_attrib *attrib;
 226
 227         /* Find object */
 228         obj = hashbin_find(objects, 0, obj_name);
 229         if (obj == NULL) {
 230                 WARNING(__FUNCTION__ "(), Unable to find object: %s\n",
 231                         obj_name);
 232                 return -1;
 233         }
 234
 235         /* Find attribute */
 236         attrib = hashbin_find(obj->attribs, 0, attrib_name);
 237         if (attrib == NULL) {
 238                 WARNING(__FUNCTION__ "(), Unable to find attribute: %s\n",
 239                         attrib_name);
 240                 return -1;
 241         }
 242
 243         if ( attrib->value->type != new_value->type) {
 244                 IRDA_DEBUG( 0, __FUNCTION__
 245                        "(), changing value type not allowed!\n");
 246                 return -1;
 247         }
 248
 249         /* Delete old value */
 250         irias_delete_value(attrib->value);
 251
 252         /* Insert new value */
 253         attrib->value = new_value;
 254
 255         /* Success */
 256         return 0;
 257 }
 258
 259 /*
 260  * Function irias_object_add_integer_attrib (obj, name, value)
 261  *
 262  *    Add an integer attribute to an LM-IAS object
 263  *
 264  */
 265 void irias_add_integer_attrib(struct ias_object *obj, char *name, int value)
 266 {
 267         struct ias_attrib *attrib;
 268
 269         ASSERT(obj != NULL, return;);
 270         ASSERT(obj->magic == IAS_OBJECT_MAGIC, return;);
 271         ASSERT(name != NULL, return;);
 272
 273         attrib = (struct ias_attrib *) kmalloc(sizeof(struct ias_attrib),
 274                                                GFP_ATOMIC);
 275         if (attrib == NULL) {
 276                 WARNING(__FUNCTION__ "(), Unable to allocate attribute!\n");
 277                 return;
 278         }
 279         memset(attrib, 0, sizeof( struct ias_attrib));
 280
 281         attrib->magic = IAS_ATTRIB_MAGIC;
 282         attrib->name = strdup(name);
 283
 284         /* Insert value */
 285         attrib->value = irias_new_integer_value(value);
 286
 287         irias_add_attrib(obj, attrib);
 288 }
 289
 290  /*
 291  * Function irias_add_octseq_attrib (obj, name, octet_seq, len)
 292  *
 293  *    Add a octet sequence attribute to an LM-IAS object
 294  *
 295  */
 296
 297 void irias_add_octseq_attrib(struct ias_object *obj, char *name, __u8 *octets,
 298                              int len)
 299 {
 300         struct ias_attrib *attrib;
 301
 302         ASSERT(obj != NULL, return;);
 303         ASSERT(obj->magic == IAS_OBJECT_MAGIC, return;);
 304
 305         ASSERT(name != NULL, return;);
 306         ASSERT(octets != NULL, return;);
 307
 308         attrib = (struct ias_attrib *) kmalloc(sizeof(struct ias_attrib),
 309                                                GFP_ATOMIC);
 310         if (attrib == NULL) {
 311                 WARNING(__FUNCTION__
 312                         "(), Unable to allocate attribute!\n");
 313                 return;
 314         }
 315         memset(attrib, 0, sizeof( struct ias_attrib));
 316
 317         attrib->magic = IAS_ATTRIB_MAGIC;
 318         attrib->name = strdup( name);
 319
 320         attrib->value = irias_new_octseq_value( octets, len);
 321
 322         irias_add_attrib(obj, attrib);
 323 }
 324
 325 /*
 326  * Function irias_object_add_string_attrib (obj, string)
 327  *
 328  *    Add a string attribute to an LM-IAS object
 329  *
 330  */
 331 void irias_add_string_attrib(struct ias_object *obj, char *name, char *value)
 332 {
 333         struct ias_attrib *attrib;
 334
 335         ASSERT(obj != NULL, return;);
 336         ASSERT(obj->magic == IAS_OBJECT_MAGIC, return;);
 337
 338         ASSERT(name != NULL, return;);
 339         ASSERT(value != NULL, return;);
 340
 341         attrib = (struct ias_attrib *) kmalloc(sizeof( struct ias_attrib),
 342                                                GFP_ATOMIC);
 343         if (attrib == NULL) {
 344                 WARNING(__FUNCTION__ "(), Unable to allocate attribute!\n");
 345                 return;
 346         }
 347         memset(attrib, 0, sizeof( struct ias_attrib));
 348
 349         attrib->magic = IAS_ATTRIB_MAGIC;
 350         attrib->name = strdup(name);
 351
 352         attrib->value = irias_new_string_value(value);
 353
 354         irias_add_attrib(obj, attrib);
 355 }
 356
 357 /*
 358  * Function irias_new_integer_value (integer)
 359  *
 360  *    Create new IAS integer value
 361  *
 362  */
 363 struct ias_value *irias_new_integer_value(int integer)
 364 {
 365         struct ias_value *value;
 366
 367         value = kmalloc(sizeof( struct ias_value), GFP_ATOMIC);
 368         if (value == NULL) {
 369                 WARNING(__FUNCTION__ "(), Unable to kmalloc!\n");
 370                 return NULL;
 371         }
 372         memset(value, 0, sizeof(struct ias_value));
 373
 374         value->type = IAS_INTEGER;
 375         value->len = 4;
 376         value->t.integer = integer;
 377
 378         return value;
 379 }
 380
 381 /*
 382  * Function irias_new_string_value (string)
 383  *
 384  *    Create new IAS string value
 385  *
 386  */
 387 struct ias_value *irias_new_string_value(char *string)
 388 {
 389         struct ias_value *value;
 390
 391         value = kmalloc(sizeof(struct ias_value), GFP_ATOMIC);
 392         if (value == NULL) {
 393                 WARNING(__FUNCTION__ "(), Unable to kmalloc!\n");
 394                 return NULL;
 395         }
 396         memset( value, 0, sizeof( struct ias_value));
 397
 398         value->type = IAS_STRING;
 399         value->charset = CS_ASCII;
 400         value->len = strlen(string);
 401         value->t.string = strdup(string);
 402
 403         return value;
 404 }
 405
 406
 407 /*
 408  * Function irias_new_octseq_value (octets, len)
 409  *
 410  *    Create new IAS octet-sequence value
 411  *
 412  */
 413 struct ias_value *irias_new_octseq_value(__u8 *octseq , int len)
 414 {
 415         struct ias_value *value;
 416
 417         value = kmalloc(sizeof(struct ias_value), GFP_ATOMIC);
 418         if (value == NULL) {
 419                 WARNING(__FUNCTION__ "(), Unable to kmalloc!\n");
 420                 return NULL;
 421         }
 422         memset(value, 0, sizeof( struct ias_value));
 423
 424         value->type = IAS_OCT_SEQ;
 425         value->len = len;
 426
 427         value->t.oct_seq = kmalloc(len, GFP_ATOMIC);
 428         if (value->t.oct_seq == NULL){
 429                 WARNING(__FUNCTION__"(), Unable to kmalloc!\n");
 430                 return NULL;
 431         }
 432         memcpy(value->t.oct_seq, octseq , len);
 433         return value;
 434 }
 435
 436 /*
 437  * Function irias_delete_value (value)
 438  *
 439  *    Delete IAS value
 440  *
 441  */
 442 void irias_delete_value(struct ias_value *value)
 443 {
 444         IRDA_DEBUG(4, __FUNCTION__ "()\n");
 445
 446         ASSERT(value != NULL, return;);
 447
 448         switch (value->type) {
 449         case IAS_INTEGER: /* Fallthrough */
 450         case IAS_MISSING:
 451                 /* No need to deallocate */
 452                 break;
 453         case IAS_STRING:
 454                 /* If string, deallocate string */
 455                 if (value->t.string != NULL)
 456                         kfree(value->t.string);
 457                 break;
 458         case IAS_OCT_SEQ:
 459                 /* If byte stream, deallocate byte stream */
 460                  if (value->t.oct_seq != NULL)
 461                          kfree(value->t.oct_seq);
 462                  break;
 463         default:
 464                 IRDA_DEBUG(0, __FUNCTION__ "(), Unknown value type!\n");
 465                 break;
 466         }
 467         kfree(value);
 468 }
 469
 470
 471