fres/cbroker/fcb.c

   1 /**************************************************************************/
   2 /* ---------------------------------------------------------------------- */
   3 /* Copyright (C) 2006 - 2008 FRESCOR consortium partners:                 */
   4 /*                                                                        */
   5 /*   Universidad de Cantabria,              SPAIN                         */
   6 /*   University of York,                    UK                            */
   7 /*   Scuola Superiore Sant'Anna,            ITALY                         */
   8 /*   Kaiserslautern University,             GERMANY                       */
   9 /*   Univ. Politécnica  Valencia,           SPAIN                        */
  10 /*   Czech Technical University in Prague,  CZECH REPUBLIC                */
  11 /*   ENEA                                   SWEDEN                        */
  12 /*   Thales Communication S.A.              FRANCE                        */
  13 /*   Visual Tools S.A.                      SPAIN                         */
  14 /*   Rapita Systems Ltd                     UK                            */
  15 /*   Evidence                               ITALY                         */
  16 /*                                                                        */
  17 /*   See http://www.frescor.org for a link to partners' websites          */
  18 /*                                                                        */
  19 /*          FRESCOR project (FP6/2005/IST/5-034026) is funded             */
  20 /*       in part by the European Union Sixth Framework Programme          */
  21 /*       The European Union is not liable of any use that may be          */
  22 /*       made of this code.                                               */
  23 /*                                                                        */
  24 /*                                                                        */
  25 /*  This file is part of FRSH (FRescor ScHeduler)                         */
  26 /*                                                                        */
  27 /* FRSH is free software; you can redistribute it and/or modify it        */
  28 /* under terms of the GNU General Public License as published by the      */
  29 /* Free Software Foundation; either version 2, or (at your option) any    */
  30 /* later version.  FRSH is distributed in the hope that it will be        */
  31 /* useful, but WITHOUT ANY WARRANTY; without even the implied warranty    */
  32 /* of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU    */
  33 /* General Public License for more details. You should have received a    */
  34 /* copy of the GNU General Public License along with FRSH; see file       */
  35 /* COPYING. If not, write to the Free Software Foundation, 675 Mass Ave,  */
  36 /* Cambridge, MA 02139, USA.                                              */
  37 /*                                                                        */
  38 /* As a special exception, including FRSH header files in a file,         */
  39 /* instantiating FRSH generics or templates, or linking other files       */
  40 /* with FRSH objects to produce an executable application, does not       */
  41 /* by itself cause the resulting executable application to be covered     */
  42 /* by the GNU General Public License. This exception does not             */
  43 /* however invalidate any other reasons why the executable file might be  */
  44 /* covered by the GNU Public License.                                     */
  45 /**************************************************************************/
  46
  47 /**
  48  * @file   fcb.c
  49  * @author Michal Sojka <sojkam1@fel.cvut.cz>
  50  * @date   Mon Oct 20 18:00:18 2008
  51  *
  52  * @brief  FRESCOR Contract Broker
  53  *
  54  *
  55  */
  56 #define WITH_C99                /* For ul_gsa.h iterators */
  57 #include <semaphore.h>
  58 #include <getopt.h>
  59 #include <forb.h>
  60 #include <forb/config.h>
  61 #include <fcb.h>
  62 #include <fcb_contact_info.h>
  63 #include <error.h>
  64 #include <errno.h>
  65 #include <stdio.h>
  66 #include <ul_gavlcust.h>
  67 #include <ul_gsacust.h>
  68 #include <string.h>
  69 #include <ul_log.h>
  70 #include <ul_logreg.h>
  71 #include <forb/server_id.h>
  72 #include <fres_contract.h>
  73 #include "fcb_config.h"
  74 #include <fosa_clocks_and_timers.h>
  75 #include "contract_log.h"
  76 #if CONFIG_FCB_INET && !CONFIG_FORB_PROTO_INET_DEFAULT
  77 #include <forb/proto_inet.h>
  78 #endif
  79
  80 #define COMPILE_TIME_ASSERT(cond, msg) \
  81         typedef char msg[(cond) ? 1 : -1]
  82
  83
  84 UL_LOG_CUST(ulogd_fcb);
  85 ul_log_domain_t ulogd_fcb = {UL_LOGL_MSG, "main"};
  86 UL_LOGREG_SINGLE_DOMAIN_INIT_FUNCTION(init_ulogd_fcb, ulogd_fcb);
  87
  88 bool opt_daemon = false;
  89 char *opt_pidfile = NULL;
  90 fosa_abs_time_t start_time;
  91
  92 /** List of contracts to be newly reserved or changed by resource manager */
  93 struct reservation_list {
  94         ul_list_head_t fcb_contracts;
  95         unsigned length;
  96 };
  97
  98 /**
  99  * Resource identification
 100  */
 101 struct res_key {
 102         frsh_resource_type_t type;
 103         frsh_resource_id_t id;
 104 };
 105
 106 /**
 107  * Registered resource
 108  */
 109 struct resource {
 110         gavl_node_t node;
 111         struct res_key key;
 112         char *name;
 113         fres_resource_manager mng; /**< Object reference of the resource manager */
 114         gavl_cust_root_field_t allocators; /**< Registered allocators for this resource (from multiple applications/nodes) */
 115         ul_list_head_t sc_contracts; /**< Negotiated contracts with spare capacity for this resource */
 116         struct reservation_list rl; /**< Temporary list of contracts to be reserved on this resource */
 117 };
 118
 119 /**
 120  * Resource allocator registered in different nodes/applications
 121  */
 122 struct res_alloc {
 123         gavl_node_t node;
 124         forb_server_id app;
 125         fres_resource_allocator ra;
 126 };
 127
 128 struct fcb_transaction;
 129
 130 struct fcb_contract {
 131         fres_contract_id_t id;
 132         struct res_alloc *ra;   /**< Allocator for this contract TODO: Remove contract if allocator is destroyed */
 133         gavl_node_t node_fcb;
 134         ul_list_node_t node_sc;
 135         ul_list_node_t node_reservation;
 136         struct fcb_transaction *transaction;
 137         struct {
 138                 int initial;
 139                 int try;
 140         } sc_variant;
 141         fosa_abs_time_t end_of_stability_period;
 142         struct fres_contract *user_contract; /* The contract sent by user. Set after sucessfull neotiation. */
 143         struct fres_contract *requested_contract; /* User request for the contract. Set by prepare_reservation_requests() in the beginning of negotiation. */
 144         struct fres_contract *to_be_reserved_contract;
 145         struct fres_contract *schedulable_contract;
 146 };
 147
 148 struct fcb_transaction {
 149         char *name;
 150         gavl_node_t node;
 151         gsa_array_field_t contracts;
 152 };
 153
 154 /**
 155  * Contract broker data
 156  */
 157 struct fcb {
 158         fres_contract_id_t contract_counter;
 159         gavl_cust_root_field_t resources; /**< Registered resources */
 160         gavl_cust_root_field_t contracts; /**< Contracts negotiated by this FCB */
 161         gavl_cust_root_field_t transactions; /**< Transactions negotiated by this FCB */
 162 };
 163
 164 struct fcb_contract *fcb_contract_new(fres_contract_id_t *id)
 165 {
 166         struct fcb_contract *fcb_contract;
 167
 168         fcb_contract = malloc(sizeof(*fcb_contract));
 169         if (!fcb_contract) {
 170                 return NULL;
 171         }
 172         memset(fcb_contract, 0, sizeof(*fcb_contract));
 173         fcb_contract->id = *id;
 174
 175         return fcb_contract;
 176 }
 177
 178 void fcb_contract_destroy(struct fcb_contract *fcb_contract)
 179 {
 180         if (fcb_contract->user_contract) {
 181                 fres_contract_destroy(fcb_contract->user_contract);
 182         }
 183         if (fcb_contract->to_be_reserved_contract) {
 184                 fres_contract_destroy(fcb_contract->to_be_reserved_contract);
 185         }
 186         if (fcb_contract->requested_contract) {
 187                 fres_contract_destroy(fcb_contract->requested_contract);
 188         }
 189         if (fcb_contract->schedulable_contract) {
 190                 fres_contract_destroy(fcb_contract->requested_contract);
 191         }
 192         free(fcb_contract);
 193 }
 194
 195 static inline int
 196 unsorted(const void *a, const void *b)
 197 { abort(); }
 198
 199 /* Unordered dynamic array of contracts in transaction */
 200 GSA_CUST_DEC(tran_contract      /* cust_prefix */,
 201              struct fcb_transaction /* cust_array_t */,
 202              struct fcb_contract/* cust_item_t */,
 203              fres_contract_id_t /* cust_key_t */,
 204              contracts          /* cust_array_field */,
 205              id                 /* cust_item_key */,
 206              unsorted           /* cust_cmp_fnc */);
 207
 208 GSA_CUST_IMP(tran_contract      /* cust_prefix */,
 209              struct fcb_transaction /* cust_array_t */,
 210              struct fcb_contract/* cust_item_t */,
 211              fres_contract_id_t /* cust_key_t */,
 212              contracts          /* cust_array_field */,
 213              id                 /* cust_item_key */,
 214              unsorted           /* cust_cmp_fnc */,
 215              true               /* cust_ins_fl */);
 216
 217 struct fcb_transaction *fcb_transaction_new(char *name)
 218 {
 219         struct fcb_transaction *fcb_transaction;
 220
 221         fcb_transaction = malloc(sizeof(*fcb_transaction));
 222         if (!fcb_transaction) {
 223                 return NULL;
 224         }
 225         memset(fcb_transaction, 0, sizeof(*fcb_transaction));
 226         fcb_transaction->name = strdup(name);
 227
 228         tran_contract_init_array_field(fcb_transaction);
 229
 230         return fcb_transaction;
 231 }
 232
 233 void fcb_transaction_destroy(struct fcb_transaction *fcb_transaction)
 234 {
 235         free(fcb_transaction->name);
 236         free(fcb_transaction);
 237 }
 238
 239 static inline int res_key_cmp(const struct res_key *a,
 240                               const struct res_key *b)
 241 {
 242         if (a->type < b->type) {
 243                 return -1;
 244         } else if (a->type > b->type) {
 245                 return +1;
 246         } else if (a->id < b->id) {
 247                 return -1;
 248         } else if (a->id > b->id) {
 249                 return +1;
 250         } else {
 251                 return 0;
 252         }
 253 }
 254
 255 /* Container for registered resources */
 256 GAVL_CUST_NODE_INT_DEC(fcb_resource   /* cust_prefix */,                \
 257                        struct fcb     /* cust_root_t */,                \
 258                        struct resource/* cust_item_t */,                \
 259                        struct res_key /* cust_key_t */,                 \
 260                        resources      /* cust_root_node */,             \
 261                        node           /* cust_item_node */,             \
 262                        key            /* cust_item_key */,              \
 263                        res_key_cmp    /* cust_cmp_fnc */);
 264
 265 GAVL_CUST_NODE_INT_IMP(fcb_resource   /* cust_prefix */,                \
 266                        struct fcb     /* cust_root_t */,                \
 267                        struct resource/* cust_item_t */,                \
 268                        struct res_key /* cust_key_t */,                 \
 269                        resources      /* cust_root_node */,             \
 270                        node           /* cust_item_node */,             \
 271                        key            /* cust_item_key */,              \
 272                        res_key_cmp    /* cust_cmp_fnc */);
 273
 274 /* Container for allocators registered for a given resource */
 275 GAVL_CUST_NODE_INT_DEC(fcb_alloc        /* cust_prefix */,              \
 276                        struct resource  /* cust_root_t */,              \
 277                        struct res_alloc /* cust_item_t */,              \
 278                        forb_server_id   /* cust_key_t */,               \
 279                        allocators       /* cust_root_node */,           \
 280                        node             /* cust_item_node */,           \
 281                        app              /* cust_item_key */,            \
 282                        fres_contract_id_cmp /* cust_cmp_fnc */);
 283
 284 GAVL_CUST_NODE_INT_IMP(fcb_alloc        /* cust_prefix */,              \
 285                        struct resource   /* cust_root_t */,             \
 286                        struct res_alloc /* cust_item_t */,              \
 287                        forb_server_id   /* cust_key_t */,               \
 288                        allocators       /* cust_root_node */,           \
 289                        node             /* cust_item_node */,           \
 290                        app              /* cust_item_key */,            \
 291                        forb_server_id_cmp /* cust_cmp_fnc */);
 292
 293 /* Container for contracts with spare capacity negotiated for a given resource */
 294 UL_LIST_CUST_DEC(sc_contracts        /* cust_prefix */,                 \
 295                  struct resource  /* cust_head_t */,                    \
 296                  struct fcb_contract /* cust_item_t */,                 \
 297                  sc_contracts   /* cust_head_field */,                  \
 298                  node_sc        /* cust_node_field */);
 299
 300 UL_LIST_CUST_DEC(reservation_list        /* cust_prefix */,             \
 301                  struct reservation_list  /* cust_head_t */,            \
 302                  struct fcb_contract /* cust_item_t */,                 \
 303                  fcb_contracts  /* cust_head_field */,                  \
 304                  node_reservation /* cust_node_field */);
 305
 306 /* Container for negotiated contracts */
 307 GAVL_CUST_NODE_INT_DEC(fcb_contract         /* cust_prefix */,          \
 308                        struct fcb           /* cust_root_t */,          \
 309                        struct fcb_contract  /* cust_item_t */,          \
 310                        fres_contract_id_t   /* cust_key_t */,           \
 311                        contracts            /* cust_root_node */,       \
 312                        node_fcb             /* cust_item_node */,       \
 313                        id                   /* cust_item_key */,        \
 314                        fres_contract_id_cmp /* cust_cmp_fnc */);
 315
 316 #if 1
 317 GAVL_CUST_NODE_INT_IMP(fcb_contract         /* cust_prefix */,          \
 318                        struct fcb           /* cust_root_t */,          \
 319                        struct fcb_contract  /* cust_item_t */,          \
 320                        fres_contract_id_t   /* cust_key_t */,           \
 321                        contracts            /* cust_root_node */,       \
 322                        node_fcb             /* cust_item_node */,       \
 323                        id                   /* cust_item_key */,        \
 324                        fres_contract_id_cmp /* cust_cmp_fnc */);
 325 #else
 326 #include "fcb_contract_gavl.inc"
 327 #endif
 328
 329 static inline int
 330 fcb_transaction_cmp(char * const *a, char * const *b)
 331 { return strcmp(*a, *b); }
 332
 333 GAVL_CUST_NODE_INT_DEC(fcb_transaction      /* cust_prefix */,          \
 334                        struct fcb           /* cust_root_t */,          \
 335                        struct fcb_transaction /* cust_item_t */,        \
 336                        char*                /* cust_key_t */,           \
 337                        transactions         /* cust_root_node */,       \
 338                        node                 /* cust_item_node */,       \
 339                        name                 /* cust_item_key */,        \
 340                        fcb_transaction_cmp /* cust_cmp_fnc */);
 341
 342 GAVL_CUST_NODE_INT_IMP(fcb_transaction      /* cust_prefix */,          \
 343                        struct fcb           /* cust_root_t */,          \
 344                        struct fcb_transaction /* cust_item_t */,        \
 345                        char*                /* cust_key_t */,           \
 346                        transactions         /* cust_root_node */,       \
 347                        node                 /* cust_item_node */,       \
 348                        name                 /* cust_item_key */,        \
 349                        fcb_transaction_cmp /* cust_cmp_fnc */);
 350
 351 struct res_array {
 352         gsa_array_field_t array;
 353 };
 354
 355 GSA_CUST_DEC(res_array          /* cust_prefix */,
 356              struct res_array   /* cust_array_t */,
 357              struct resource    /* cust_item_t */,
 358              struct res_key     /* cust_key_t */,
 359              array              /* cust_array_field */,
 360              key                /* cust_item_key */,
 361              res_key_cmp        /* cust_cmp_fnc */);
 362
 363 GSA_CUST_IMP(res_array          /* cust_prefix */,
 364              struct res_array   /* cust_array_t */,
 365              struct resource    /* cust_item_t */,
 366              struct res_key     /* cust_key_t */,
 367              array              /* cust_array_field */,
 368              key                /* cust_item_key */,
 369              res_key_cmp        /* cust_cmp_fnc */,
 370              true               /* cust_ins_fl */);
 371
 372
 373
 374 #define o2fcb(o) (struct fcb*)forb_instance_data(o)
 375
 376 static struct res_key*
 377 get_res_key(const struct fres_contract *contract, struct res_key *key)
 378 {
 379         fres_block_resource *block_res;
 380
 381         block_res = fres_contract_get_resource(contract);
 382         if (!block_res) {
 383                 ul_logerr("No resource specified\n");
 384                 return NULL;
 385         } else {
 386                 key->type = block_res->resource_type;
 387                 key->id = block_res->resource_id;
 388         }
 389         return key;
 390 }
 391
 392 static struct res_key*
 393 get_fc_res_key(const struct fcb_contract *fc, struct res_key *key)
 394 {
 395         if (fc->user_contract)
 396                 get_res_key(fc->user_contract, key);
 397         else
 398                 get_res_key(fc->requested_contract, key);
 399         return key;
 400 }
 401
 402 /**
 403  * Fills in an array of fcb_contracts according to requests submited
 404  * by an application through negotiate_contracts() or
 405  * negotiate_transaction(). For every contract in @a contracts, there
 406  * is allocated one fcb_contract in @a fcb_contracts array.
 407  *
 408  * @param fcb
 409  * @param fcb_contracts Where to store pointers to fcb_contracts
 410  * @param contracts Contracts submited for negotiation
 411  * @param num Number of contracts in contracts (which is the same as the number in fcb_contracts).
 412  *
 413  * @return Zero on success, non-zero error code on error.
 414  */
 415 static int
 416 prepare_fcb_contracts(struct fcb *fcb, struct fcb_contract *fcb_contracts[],
 417                       struct fres_contract *contracts[], int num)
 418 {
 419         unsigned i;
 420         struct fcb_contract *fc;
 421
 422         for (i=0; i<num; i++) {
 423                 struct fres_contract *c = contracts[i];
 424
 425                 if (fres_contract_id_is_empty(&c->id)) {
 426                         /* Normal negotiation request */
 427                         COMPILE_TIME_ASSERT(sizeof(c->id) == sizeof(fcb->contract_counter),
 428                                             wrong_size_of_contract_id);
 429                         c->id = ++fcb->contract_counter;
 430                         fc = fcb_contract_new(&c->id);
 431                         if (!fc)
 432                                 return errno;
 433                         fcb_contracts[i] = fc;
 434                         log_contract("Negotiation request", i, c);
 435                 } else {
 436                         fc = fcb_contract_find(fcb, &c->id);
 437                         if (!fc) {
 438                                 char str[60];
 439                                 fres_contract_id_to_string(str, &c->id, sizeof(str));
 440                                 ul_logerr("Attempt to change unknown contract %s\n", str);
 441                                 return FRES_ERR_NOTHING_TO_RENEGOTIATE;
 442                         } else {
 443                                 fcb_contracts[i] = fc;
 444                                 if (fres_contract_get_num_blocks(c) == 0) {
 445                                         /* Cancelation */
 446                                         log_contract("Cancelation request", i, fc->user_contract);
 447                                 } else {
 448                                         /* Renegotiation */
 449                                         log_contract("Renegotiation request", i, fc->user_contract);
 450                                 }
 451                         }
 452                 }
 453                 fc->requested_contract = c;
 454         }
 455         return 0;
 456 }
 457
 458 /**
 459  * Ensure that all contracts belong to the same resource and find
 460  * resource allocators for the contracts.
 461  *
 462  * @param fcb
 463  * @param fcb_contracts Array of fcb_contracts prepared by prepare_fcb_contracts()
 464  * @param num Number of contracts in @a fcb_contracts
 465  * @param resource Resource for which negotiation is being done.
 466  * @param app Application which requests negotiation
 467  */
 468 static int
 469 check_and_setup_resource(struct fcb *fcb, struct fcb_contract *fcb_contracts[],
 470                          struct resource **resource,
 471                          forb_server_id *app,
 472                          int num)
 473 {
 474         unsigned i;
 475         struct res_alloc *ra;
 476         struct res_key key, key2 = {-1,-1};
 477
 478         for (i=0; i<num; i++) {
 479                 struct fcb_contract *fc = fcb_contracts[i];
 480
 481                 if (!get_fc_res_key(fc, &key))
 482                         return FRSH_ERR_RESOURCE_ID_INVALID;
 483
 484                 /* Check that all contracts are for the same resource */
 485                 if (i==0) {
 486                         key2 = key;
 487                         *resource = fcb_resource_find(fcb, &key);
 488                         if (!*resource) {
 489                                 ul_logerr("No resource manager for %d.%d registered\n",
 490                                           key.type, key.id);
 491                                 return FRES_ERR_NO_RESOURCE_MANAGER;
 492                         }
 493                         /* Find allocator for this request */
 494                         ra = fcb_alloc_find(*resource, app);
 495                         if (!ra) {
 496                                 char str[60];
 497                                 forb_server_id_to_string(str, app, sizeof(str));
 498                                 ul_logerr("No resource allocator found for %d.%d and %s\n",
 499                                           (*resource)->key.type, (*resource)->key.id, str);
 500                                 return FRES_ERR_NO_RESOURCE_ALLOCATOR;
 501                         }
 502                 }
 503                 else if (key.type != key2.type ||
 504                          key.id   != key2.id) {
 505                         ul_logerr("Contract #%d differs in resource!\n", i);
 506                         return FRSH_ERR_RESOURCE_ID_INVALID;
 507                 }
 508                 fc->ra = ra;
 509         }
 510         return 0;
 511 }
 512
 513 /**
 514  * Prepares a list of contracts to pass to resource manager for (re)reserving.
 515  *
 516  * @todo Needs to be changed for compatibility with transactions.
 517  *
 518  * @param resource Resource for which to rebalance capacity and negotiate new contracts
 519  * @param fcb_contract New requests to negotiate
 520  * @param num The number of elements in @a fcb_contract
 521  * @param[out] rl List with changed contracts to be commited
 522  */
 523 static void
 524 prepare_reservation_list(struct resource *resource,
 525                          struct fcb_contract *fcb_contract[], int num)
 526 {
 527         int i;
 528         fosa_abs_time_t now;
 529         struct fcb_contract *fc;
 530
 531         reservation_list_init_head(&resource->rl);
 532         resource->rl.length = 0;
 533         for (i=0; i<num; i++) {
 534                 assert(fcb_contract[i]->requested_contract != NULL);
 535                 reservation_list_insert(&resource->rl, fcb_contract[i]);
 536                 resource->rl.length++;
 537         }
 538         fosa_clock_get_time(CLOCK_REALTIME, &now);
 539         ul_list_for_each(sc_contracts, resource, fc) {
 540                 if (fosa_abs_time_smaller(fc->end_of_stability_period, now) &&
 541                     fc->requested_contract == NULL) /* Do not insert contract inserted above */
 542                 {
 543                         reservation_list_insert(&resource->rl, fc);
 544                         resource->rl.length++;
 545                 }
 546         }
 547 }
 548
 549 static int
 550 reserve_resource(struct resource *resource)
 551 {
 552         int ret, i;
 553         fres_contract_ptr_seq contracts;
 554         struct fres_contract *c;
 555         struct fcb_contract *fc;
 556         CORBA_Environment ev;
 557
 558         if (!forb_sequence_alloc_buf(&contracts, resource->rl.length)) {
 559                 ret = errno;
 560                 goto err;
 561         }
 562         forb_sequence_length(&contracts) = resource->rl.length;
 563
 564         i=0;
 565         /* Prepare FORB sequence  */
 566         ul_list_for_each(reservation_list, &resource->rl, fc) {
 567                 c = NULL;
 568                 if (fc->to_be_reserved_contract)
 569                         /* Contract without spare capacity */
 570                         c = fc->to_be_reserved_contract;
 571                 else if (fc->requested_contract)
 572                         c = fc->requested_contract;
 573                 assert(c);
 574                 forb_sequence_elem(&contracts, i++) = c;
 575         }
 576
 577         /* Reserve contract */
 578         ret = fres_resource_manager_reserve_contracts(resource->mng, &contracts, &ev);
 579         if (forb_exception_occurred(&ev)) {
 580                 ret = fres_forbex2err(&ev);
 581                 ul_logerr("FORB exception when reserving contracts\n");
 582                 goto err_free;
 583         }
 584         if (ret < 0) {
 585                 ul_logerr("Contract reservation error %d\n", ret);
 586                 ret = FRES_ERR_ADMISSION_TEST;
 587                 goto err_free;
 588         } else if (ret == 0)
 589                 ret = FRSH_NO_ERROR;
 590         else if (ret == 1)
 591                 ret = FRSH_ERR_CONTRACT_REJECTED;
 592         else
 593                 assert(false);
 594 err_free:
 595         forb_sequence_free_buf(&contracts, forb_no_destructor);
 596 err:
 597         return ret;
 598 }
 599
 600 /**
 601  *
 602  *
 603  * @param resource Resource for which to rebalance capacity and negotiate new contracts
 604  * @param rl List with changed contracts to be commited
 605  *
 606  * @return Zero on success, non-zero error code on error
 607  */
 608 static int
 609 rebalance_spare_capacity_and_reserve(struct resource *resource)
 610 {
 611         int ret;
 612         struct reservation_list *rl = &resource->rl;
 613         struct fcb_contract *fc;
 614         fres_block_spare_capacity *s;
 615
 616         /* Initialize optimization */
 617         ul_list_for_each(reservation_list, rl, fc) {
 618                 fc->to_be_reserved_contract =
 619                         fc->requested_contract ? fres_contract_duplicate(fc->requested_contract) :
 620                         fc->user_contract ? fres_contract_duplicate(fc->user_contract) :
 621                         NULL;
 622                 assert(fc->to_be_reserved_contract != NULL);
 623
 624                 s = fres_contract_get_spare_capacity(fc->to_be_reserved_contract);
 625                 if (s && s->granularity == FRSH_GR_DISCRETE) {
 626                         fc->sc_variant.initial = s->variants._length - 1;
 627                         fc->sc_variant.try = fc->sc_variant.initial;
 628                 }
 629         }
 630
 631         bool all_combinations_tried;
 632         int criterion, best_criterion = -1;
 633         struct fcb_contract *fcb_changed;
 634         /* Exhaustive search. Try all combinations of spare capacity
 635          * variants and find the one with best creterion. */
 636         do {
 637                 all_combinations_tried = true;
 638                 fcb_changed = NULL;
 639                 criterion = 0;
 640                 /* Prepare spare capacity variant */
 641                 ul_list_for_each(reservation_list, rl, fc) {
 642                         s = fres_contract_get_spare_capacity(fc->to_be_reserved_contract);
 643                         /* TODO: Simulate continuous granularity by discretization */
 644                         if (s && s->granularity == FRSH_GR_DISCRETE) {
 645                                 fres_container_copy(fc->to_be_reserved_contract->container,
 646                                                     forb_sequence_elem(&s->variants, fc->sc_variant.try));
 647                                 criterion += fc->sc_variant.try;
 648
 649                                 if (fcb_changed == NULL) {
 650                                         /* Chnage tried variant for the next round */
 651                                         fc->sc_variant.try = fc->sc_variant.try > 0 ?
 652                                                 fc->sc_variant.try - 1 :
 653                                                 s->variants._length - 1;
 654                                         /* Do not change other
 655                                          * contracts unless we have
 656                                          * tried all variants */
 657                                         if (fc->sc_variant.try != fc->sc_variant.initial) {
 658                                                 fcb_changed = fc;
 659                                         }
 660                                 }
 661                                 if (fc->sc_variant.try != fc->sc_variant.initial)
 662                                         all_combinations_tried = false;
 663                         }
 664                 }
 665
 666                 if (criterion > best_criterion) {
 667                         ret = reserve_resource(resource);
 668                         switch (ret) {
 669                         case FRSH_NO_ERROR:
 670                                 best_criterion = criterion;
 671                                 break;
 672                         case FRSH_ERR_CONTRACT_REJECTED:
 673                                 break;
 674                         default:
 675                                 goto err;
 676                         }
 677                 }
 678         } while (!all_combinations_tried);
 679
 680         if (best_criterion == -1) {
 681                 ret = FRSH_ERR_CONTRACT_REJECTED;
 682         } else {
 683                 /* At least some variant succeeded */
 684                 ret = 0;
 685                 sc_contracts_init_head(resource);
 686                 ul_list_for_each(reservation_list, rl, fc) {
 687                         s = fres_contract_get_spare_capacity(fc->to_be_reserved_contract);
 688                         if (s && s->granularity == FRSH_GR_DISCRETE) {
 689                                 sc_contracts_insert(resource, fc);
 690                         }
 691                 }
 692         }
 693 err:
 694         ul_list_for_each(reservation_list, rl, fc) {
 695                 fres_contract_destroy(fc->to_be_reserved_contract);
 696                 fc->to_be_reserved_contract = NULL;
 697         }
 698         return ret;
 699 }
 700
 701 /**
 702  * Create/change VReses according to @a schedulable_contracts.
 703  *
 704  * There might be more allocators for schedulable contracts, so merge
 705  * adjacent vreses with the same allocator together and create/change
 706  * them in one step. Also the order of schedulable contracts might be
 707  * different from the initial order od ids in commit_contracts()
 708  * therefore we have to search for every contract.
 709  */
 710 static int
 711 change_vreses(struct fcb *fcb, fres_contract_ptr_seq *schedulable_contracts)
 712 {
 713         struct res_alloc *last_ra = NULL;
 714         fres_contract_ptr_seq vreses;
 715         int i, ret = 0;
 716         CORBA_Environment ev;
 717
 718         if (!forb_sequence_alloc_buf(&vreses, schedulable_contracts->_length)) {
 719                 return errno;
 720         }
 721         vreses._length = 0;
 722
 723         for (i=0; i<schedulable_contracts->_length; i++) {
 724                 struct fcb_contract *fc;
 725                 struct fres_contract *sc = schedulable_contracts->_buffer[i];
 726
 727                 log_contract("Changing VRES", i, sc);
 728
 729                 fc = fcb_contract_find(fcb, &sc->id);
 730                 assert(fc != NULL);
 731
 732                 if (true /* TODO: if the schedulable contract is changed */) {
 733                         if (last_ra != fc->ra) {
 734                                 if (vreses._length) {
 735                                         ret = fres_resource_allocator_change_vreses(last_ra->ra,
 736                                                                                     &vreses, &ev);
 737                                         if (forb_exception_occurred(&ev)) {
 738                                                 ret = fres_forbex2err(&ev);
 739                                                 goto err;
 740                                         }
 741                                         if (ret) goto err;
 742                                 }
 743                                 vreses._length = 0;
 744                         }
 745                         vreses._buffer[vreses._length] = sc;
 746                         vreses._length++;
 747                         last_ra = fc->ra;
 748
 749                 }
 750         }
 751         if (last_ra) {
 752                 ret = fres_resource_allocator_change_vreses(last_ra->ra,
 753                                                             &vreses, &ev);
 754                 if (forb_exception_occurred(&ev))
 755                         ret = fres_forbex2err(&ev);
 756         }
 757 err:
 758         forb_sequence_free_buf(&vreses, forb_no_destructor);
 759         return ret;
 760 }
 761
 762 void
 763 free_fcb_contracts(struct fcb_contract *fcb_contracts[], int num)
 764 {
 765         int i;
 766         struct fcb_contract *fc;
 767         for (i=0; i<num; i++) {
 768                 fc = fcb_contracts[i];
 769                 if (fc && !fc->user_contract) {
 770                         fc->requested_contract = NULL; /* Destroyed by FORB */
 771                         fcb_contract_destroy(fc);
 772                 }
 773         }
 774         free(fcb_contracts);
 775 }
 776
 777 int
 778 commit_resource(struct resource *resource,
 779                 fres_contract_ptr_seq **schedulable_contracts)
 780 {
 781         int ret;
 782         fres_contract_id_seq commit_ids;
 783         int i;
 784         struct fcb_contract *fc;
 785         CORBA_Environment ev;
 786
 787         if (!forb_sequence_alloc_buf(&commit_ids, resource->rl.length)) {
 788                 ret = errno;
 789                 goto err;
 790         }
 791
 792         commit_ids._length = resource->rl.length;
 793         i=0;
 794         ul_list_for_each(reservation_list, &resource->rl, fc) {
 795                 forb_sequence_elem(&commit_ids, i) = fc->id;
 796                 i++;
 797         }
 798
 799         fres_resource_manager_commit_contracts(resource->mng, &commit_ids,
 800                                                schedulable_contracts, &ev);
 801         if (forb_exception_occurred(&ev)) {
 802                 ret = fres_forbex2err(&ev);
 803                 goto err_free;
 804         }
 805         return 0;
 806 err_free:
 807         forb_sequence_free_buf(&commit_ids, forb_no_destructor);
 808 err:
 809         return ret;
 810 }
 811
 812 int cancel_reservations(struct resource *resource)
 813 {
 814         int ret;
 815         fres_contract_id_seq commit_ids;
 816         int i;
 817         struct fcb_contract *fc;
 818         CORBA_Environment ev;
 819
 820         if (!forb_sequence_alloc_buf(&commit_ids, resource->rl.length)) {
 821                 ret = errno;
 822                 goto err;
 823         }
 824
 825         commit_ids._length = resource->rl.length;
 826         i=0;
 827         ul_list_for_each(reservation_list, &resource->rl, fc) {
 828                 forb_sequence_elem(&commit_ids, i) = fc->id;
 829                 i++;
 830         }
 831
 832         fres_resource_manager_cancel_reservations(resource->mng, &commit_ids, &ev);
 833         if (forb_exception_occurred(&ev)) {
 834                 ret = fres_forbex2err(&ev);
 835                 goto err_free;
 836         }
 837
 838         return 0;
 839 err_free:
 840         forb_sequence_free_buf(&commit_ids, forb_no_destructor);
 841 err:
 842         return ret;
 843 }
 844
 845 /* Add new contracts to our fcb database for later
 846  * reference. Canceled contracts are removed below. */
 847 int
 848 fcb_remember_contracts(struct fcb *fcb,
 849                        struct fcb_contract **fcb_contracts, int num)
 850 {
 851         struct fcb_contract *fc;
 852         int i;
 853
 854         for (i=0; i<num; i++) {
 855                 fc =  fcb_contracts[i];
 856
 857                 if (fc->user_contract) {
 858                         if (fres_contract_get_num_blocks(fc->requested_contract) > 0) {
 859                                 /* Renegotiation */
 860                                 fres_contract_destroy(fc->user_contract);
 861                                 fc->user_contract = fres_contract_duplicate(fc->requested_contract);
 862                                 /* Note: requested_contract is also
 863                                  * pointed by contracts parameter and
 864                                  * will be freed by FORB. */
 865                                 fc->requested_contract = NULL;
 866                         }
 867                 } else {
 868                         /* Insert new contracts */
 869                         fcb_contract_insert(fcb, fcb_contracts[i]);
 870                         fc->user_contract = fres_contract_duplicate(fc->requested_contract);
 871                         fc->requested_contract = NULL;
 872                         /* See the note above. */
 873                 }
 874         }
 875         return 0;
 876 }
 877
 878 int
 879 fcb_remember_schedulable_contracts(struct fcb *fcb,
 880                                    fres_contract_ptr_seq *schedulable_contracts)
 881 {
 882         struct fcb_contract *fc;
 883         int i;
 884         for (i=0; i<schedulable_contracts->_length; i++) {
 885                 struct fres_contract *sc = schedulable_contracts->_buffer[i];
 886                 fc = fcb_contract_find(fcb, &sc->id);
 887                 assert(fc != NULL);
 888                 fres_contract_destroy(fc->schedulable_contract);
 889                 fc->schedulable_contract = fres_contract_duplicate(sc);
 890                 assert(fc->schedulable_contract);
 891         }
 892         return 0;
 893 }
 894
 895
 896 CORBA_long
 897 negotiate_contracts(fres_contract_broker obj,
 898                     const fres_contract_ptr_seq* contracts,
 899                     fres_contract_id_seq** ids_out,
 900                     CORBA_Environment *ev)
 901 {
 902         struct fcb *fcb = o2fcb(obj);
 903         struct resource *resource = NULL;
 904         int ret = 0;
 905         forb_server_id app;
 906         fres_contract_ptr_seq *schedulable_contracts;
 907         struct fcb_contract **fcb_contracts;
 908         unsigned i;
 909         int num = contracts->_length;
 910
 911         /* Prepare output sequence for the case we return eariler with
 912          * an error */
 913         forb_sequence_alloc(*ids_out, 0);
 914         if (!*ids_out) {
 915                 ev->major = FORB_EX_NO_MEMORY;
 916                 goto err;
 917         }
 918         CORBA_sequence_set_release(*ids_out, CORBA_TRUE);
 919
 920         forb_get_req_source(obj, &app);
 921
 922         fcb_contracts = malloc(sizeof(fcb_contracts[0])*num);
 923         if (!fcb_contracts) {
 924                 ret = errno;
 925                 goto err;
 926         }
 927         memset(fcb_contracts, 0, sizeof(fcb_contracts[0])*num);
 928
 929         ret = prepare_fcb_contracts(fcb, fcb_contracts,
 930                                     contracts->_buffer, num);
 931         if (ret)
 932                 goto err_free_fcb_contracts;
 933         ret = check_and_setup_resource(fcb, fcb_contracts, &resource,
 934                                        &app, num);
 935         if (ret)
 936                 goto err_free_fcb_contracts;
 937
 938         prepare_reservation_list(resource, fcb_contracts, num);
 939
 940         /* Reserve contracts */
 941         ret = rebalance_spare_capacity_and_reserve(resource);
 942         if (ret) {
 943                 if (ret == FRSH_ERR_CONTRACT_REJECTED) {
 944                         ul_logmsg("Contract(s) was/were rejected\n");
 945                 } else {
 946                         char msg[100];
 947                         fres_strerror(ret, msg, sizeof(msg));
 948                         ul_logerr("Reservation error: %s\n", msg);
 949                 }
 950                 goto err_free_fcb_contracts;
 951         }
 952
 953         /* Commit contracts */
 954         ret = commit_resource(resource, &schedulable_contracts);
 955         if (ret)
 956                 goto err_cancel_reservation;
 957
 958         fcb_remember_contracts(fcb, fcb_contracts, num);
 959         fcb_remember_schedulable_contracts(fcb, schedulable_contracts);
 960
 961         ret = change_vreses(fcb, schedulable_contracts);
 962         if (ret)
 963                 goto err_cancel_reservation;
 964
 965         forb_sequence_free(schedulable_contracts, fres_contract_ptr_destroy);
 966         if (ret != 0) {
 967                 ul_logerr("VRes was not created\n");
 968                 goto err_cancel_contracts;
 969         }
 970
 971
 972         /* Return IDs and delete canceled contracts from out database */
 973         if (!forb_sequence_alloc_buf(*ids_out, num)) {
 974                 ev->major = FORB_EX_NO_MEMORY;
 975                 goto err_cancel_contracts;
 976         }
 977         (*ids_out)->_length = num;
 978         for (i=0; i<num; i++) {
 979                 struct fcb_contract *fc =  fcb_contracts[i];
 980                 forb_sequence_elem(*ids_out, i) = fc->id;
 981
 982                 if (fc->requested_contract &&
 983                     fres_contract_get_num_blocks(fc->requested_contract) == 0) {
 984                         fcb_contract_delete(fcb, fc);
 985                         /* Note: requested_contract is also pointed by
 986                          * contracts parameter and will be freed by FORB. */
 987                         fc->requested_contract = NULL;
 988                         fcb_contract_destroy(fc);
 989                 }
 990         }
 991         return 0;
 992
 993 err_cancel_contracts:
 994         /* TODO */
 995         goto err_free_fcb_contracts;
 996 err_cancel_reservation:
 997         cancel_reservations(resource);
 998 err_free_fcb_contracts:
 999         free_fcb_contracts(fcb_contracts, num);
1000 err:
1001         return ret;
1002 }
1003
1004 void redistribute_spare_capacity(fres_contract_broker obj,
1005                                  const frsh_resource_type_t restype,
1006                                  const frsh_resource_id_t resid,
1007                                  CORBA_Environment *ev)
1008 {
1009         struct fcb *fcb = o2fcb(obj);
1010         struct res_key key = {restype, resid };
1011         struct resource *resource;
1012
1013         resource = fcb_resource_find(fcb, &key);
1014
1015         prepare_reservation_list(resource, NULL, 0);
1016
1017 /*      forb_sequence_alloc(ids, rl.length); */
1018 /*      if (!ids || !ids->_buffer) { */
1019 /*              ev->major = FORB_EX_NO_MEMORY; */
1020 /*              goto err_free_fcb_contracts; */
1021 /*      } */
1022 /*      CORBA_sequence_set_release(ids, CORBA_TRUE); */
1023 /*      *ids_out = ids;         /\* ids is freed by FORB *\/ */
1024
1025
1026         rebalance_spare_capacity_and_reserve(resource);
1027         /* Commit */
1028 }
1029
1030 CORBA_long register_resource(fres_contract_broker obj,
1031                             const frsh_resource_type_t restype,
1032                             const frsh_resource_id_t resid,
1033                             const fres_resource_desc *desc,
1034                             CORBA_Environment *ev)
1035 {
1036         struct fcb *fcb = o2fcb(obj);
1037         struct resource *res, *res2;
1038
1039         res = malloc(sizeof(*res));
1040         if (!res) goto err;
1041         memset(res, 0, sizeof(*res));
1042         res->key.type = restype;
1043         res->key.id = resid;
1044         res2 = fcb_resource_find(fcb, &res->key);
1045         if (res2) {
1046                 if (forb_object_is_stale(res2->mng)) {
1047                         ul_logmsg("Removing stale manager for resource %d.%d\n",
1048                                   restype, resid);
1049                         forb_object_release(res2->mng);
1050                         fcb_resource_delete(fcb, res2);
1051                         /* TODO: Delete also all allocators associated
1052                          * with this stale resource manager. */
1053                         free(res);
1054                         res = res2;
1055                 } else {
1056                         ul_logerr("Resource manager %d.%d already registered\n",
1057                                   restype, resid);
1058                         goto free_err;
1059                 }
1060         }
1061         res->mng = forb_object_duplicate(desc->manager);
1062         res->name = desc->name;
1063
1064         fcb_alloc_init_root_field(res);
1065         sc_contracts_init_head(res);
1066         ul_logmsg("Registering manager for resource \"%s\" (%d.%d)\n",
1067                   res->name, restype, resid);
1068         fcb_resource_insert(fcb, res);
1069         return 0;
1070 free_err:
1071         free(res);
1072 err:
1073         return -1;
1074 }
1075
1076
1077 CORBA_long register_allocator(fres_contract_broker obj,
1078                               const frsh_resource_type_t restype,
1079                               const frsh_resource_id_t resid,
1080                               const fres_resource_allocator ra_obj,
1081                               CORBA_Environment *ev)
1082 {
1083         struct fcb *fcb = o2fcb(obj);
1084         struct resource *res;
1085         struct res_alloc *ra;
1086         struct res_key resource;
1087         forb_server_id server_id;
1088         char server_id_str[40];
1089         int ret;
1090
1091         forb_get_server_id(ra_obj, &server_id);
1092         forb_server_id_to_string(server_id_str, &server_id, sizeof(server_id_str));
1093         ul_logmsg("Registering allocator for resource %d.%d in app %s\n",
1094                   restype, resid, server_id_str);
1095
1096         resource.type = restype;
1097         resource.id = resid;
1098         res = fcb_resource_find(fcb, &resource);
1099         if (!res) {
1100                 ul_logerr("No manager found for %d.%d. Unable to register the allocator!\n",
1101                           restype, resid);
1102                 ret = FRES_ERR_NO_RESOURCE_MANAGER;
1103                 goto err;
1104         }
1105         ra = fcb_alloc_find(res, &server_id);
1106         if (ra) {
1107                 char *str = forb_object_to_string(ra_obj);
1108                 ul_logerr("Allocator from already registered (%s)\n",
1109                           str);
1110                 forb_free(str);
1111                 ret = FRES_ERR_ALLOCATOR_ALREADY_REGISTERED;
1112                 goto err;
1113         }
1114         ra = malloc(sizeof(*ra));
1115         if (!ra) {
1116                 ret = ENOMEM;
1117                 goto err;
1118         }
1119         ra->app = server_id;
1120         ra->ra = forb_object_duplicate(ra_obj);
1121         fcb_alloc_insert(res, ra);
1122         return 0;
1123 err:
1124         return ret;
1125 }
1126
1127 void get_resources(fres_contract_broker obj, fres_resource_seq** resources, CORBA_Environment *ev)
1128 {
1129         struct fcb *fcb = o2fcb(obj);
1130         fres_resource_seq *seq;
1131         struct resource *res;
1132         int n;
1133
1134         seq = malloc(sizeof(*seq));
1135         if (!seq) {
1136                 ev->major = FORB_EX_NO_MEMORY;
1137                 return;
1138         }
1139         memset(seq, 0, sizeof(*seq));
1140
1141         n=0;
1142         gavl_cust_for_each(fcb_resource, fcb, res) {
1143                 n++;
1144         }
1145
1146         seq->_buffer = CORBA_sequence_fres_resource_allocbuf(n);
1147         seq->_maximum = n;
1148         seq->_length = n;
1149
1150         n = 0;
1151         gavl_cust_for_each(fcb_resource, fcb, res) {
1152                 seq->_buffer[n].restype = res->key.type;
1153                 seq->_buffer[n].resid = res->key.id;
1154                 seq->_buffer[n].desc.manager = res->mng;
1155                 seq->_buffer[n].desc.name = res->name;
1156                 n++;
1157         }
1158
1159         *resources = seq;
1160 }
1161
1162 static bool
1163 transaction_has_spare_capacity(const fres_transaction_t* transaction)
1164 {
1165         struct fres_contract **c;
1166         forb_sequence_foreach(&transaction->contracts, c)
1167                 if (fres_contract_get_spare_capacity(*c))
1168                         return true;
1169         return false;
1170 }
1171
1172 static int
1173 transaction_get_resources(struct fcb *fcb, struct fcb_contract *fc[],
1174                           int num, struct res_array *res_array)
1175 {
1176         int i;
1177         struct resource *resource;
1178         struct res_key key;
1179         int ret;
1180
1181         for (i = 0; i < num; i++) {
1182                 get_fc_res_key(fc[i], &key);
1183                 resource = fcb_resource_find(fcb, &key);
1184                 ret = res_array_insert(res_array, resource);
1185                 if (ret == -1) {
1186                         ret = FRSH_ERR_INTERNAL_ERROR;
1187                         goto err;
1188                 }
1189         }
1190         ret = 0;
1191 err:
1192         return ret;
1193 }
1194
1195 CORBA_long
1196 negotiate_transaction(fres_contract_broker _obj,
1197                       const fres_transaction_t* transaction,
1198                       CORBA_Environment *ev)
1199 {
1200         struct fcb *fcb = o2fcb(_obj);
1201         struct fcb_contract **fcb_contracts, *fc;
1202         const fres_contract_ptr_seq* user_contracts = &transaction->contracts;
1203         int i, ret, num = user_contracts->_length;
1204         struct res_array res_array;
1205         struct res_key key;
1206         struct resource *resource;
1207         fres_contract_ptr_seq *schedulable_contracts;
1208         struct fcb_transaction *ft;
1209
1210         ul_logmsg("Negotiating transaction '%s' with %d contracts\n", transaction->name, num);
1211         if (transaction_has_spare_capacity(transaction)) {
1212                 ret =  FRES_ERR_SPARE_CAPACITY_NOT_SUPPORTED;
1213                 goto err;
1214         }
1215
1216         fcb_contracts = malloc(sizeof(*fcb_contracts)*num);
1217         if (!fcb_contracts) {
1218                 ret = errno;
1219                 goto err;
1220         }
1221         memset(fcb_contracts, 0, sizeof(*fcb_contracts)*num);
1222
1223         ret = prepare_fcb_contracts(fcb, fcb_contracts,
1224                                     user_contracts->_buffer, num);
1225         if (ret)
1226                 goto err_free_fcb_contracts;
1227
1228         res_array_init_array_field(&res_array);
1229         ret = transaction_get_resources(fcb, fcb_contracts, num, &res_array);
1230
1231         gsa_cust_for_each(res_array, &res_array, resource) {
1232                 reservation_list_init_head(&resource->rl);
1233                 resource->rl.length = 0;
1234                 for (i = 0; i < num; i++) {
1235                         fc = fcb_contracts[i];
1236                         get_fc_res_key(fc, &key);
1237                         if (res_key_cmp(&key, &resource->key) == 0) {
1238                                 reservation_list_insert(&resource->rl, fc);
1239                                 resource->rl.length++;
1240                         }
1241                 }
1242         }
1243         gsa_cust_for_each(res_array, &res_array, resource) {
1244                 ret = reserve_resource(resource);
1245                 if (ret) {
1246                         ul_logerr("Reservation failed\n");
1247                         goto err_cancel_reservation;
1248                 }
1249         }
1250         fcb_remember_contracts(fcb, fcb_contracts, num);
1251         gsa_cust_for_each(res_array, &res_array, resource) {
1252                 ret = commit_resource(resource, &schedulable_contracts);
1253                 if (ret) {
1254                         ul_logerr("Commit failed\n");
1255                         goto err_cancel_reservation;
1256                 }
1257                 fcb_remember_schedulable_contracts(fcb, schedulable_contracts);
1258                 forb_sequence_free(schedulable_contracts, fres_contract_ptr_destroy);
1259         }
1260
1261         ft = fcb_transaction_new(transaction->name);
1262         if (!ft) {
1263                 ret = errno;
1264                 goto err_cancel_reservation;
1265         }
1266         enum { NONE, CANCELATION, NEGOTIATION } op = NONE;
1267         for (i = 0; i < num; i++) {
1268                 fc =  fcb_contracts[i];
1269                 if (fc->requested_contract &&
1270                     fres_contract_get_num_blocks(fc->requested_contract) == 0) {
1271                         assert(i == 0 || op == CANCELATION);
1272                         op = CANCELATION;
1273                         /* TODO: Review and test transaction cancelation!!! */
1274                         fcb_contract_delete(fcb, fc);
1275                         /* Note: requested_contract is also pointed by
1276                          * contracts parameter and will be freed by FORB. */
1277                         fc->requested_contract = NULL;
1278                         fcb_contract_destroy(fc);
1279                 } else {
1280                         assert(i == 0 || op == NEGOTIATION);
1281                         op = NEGOTIATION;
1282                         tran_contract_insert_at(ft, fc, i);
1283                         fc->transaction = ft;
1284                 }
1285         }
1286         switch (op) {
1287         case NEGOTIATION:
1288                 fcb_transaction_insert(fcb, ft);
1289                 break;
1290         case CANCELATION:
1291                 fcb_transaction_delete(fcb, ft);
1292                 fcb_transaction_destroy(ft);
1293                 break;
1294         default:
1295                 assert(false);
1296         }
1297         res_array_delete_all(&res_array);
1298         return 0;
1299 err_cancel_reservation:
1300         gsa_cust_for_each(res_array, &res_array, resource) {
1301                 cancel_reservations(resource);
1302         }
1303         res_array_delete_all(&res_array);
1304 err_free_fcb_contracts:
1305         free_fcb_contracts(fcb_contracts, num);
1306 err:
1307         return ret;
1308 }
1309
1310 CORBA_long
1311 wait_transaction(fres_contract_broker _obj,
1312                  const CORBA_char * name,
1313                  fres_transaction_t** transaction,
1314                  CORBA_Environment *ev)
1315 {
1316         return FRSH_ERR_NOT_IMPLEMENTED;
1317 }
1318
1319 CORBA_long
1320 allocate_transaction_vres(fres_contract_broker _obj,
1321                           const CORBA_char * name,
1322                           const CORBA_long index,
1323                           fres_contract_id_t *id,
1324                           CORBA_Environment *ev)
1325 {
1326         struct fcb *fcb = o2fcb(_obj);
1327         struct fcb_transaction *ft;
1328         struct fcb_contract *fc;
1329         int ret;
1330         struct res_alloc *ra;
1331         char * const *n = (char * const *)&name;
1332         struct res_key key;
1333         struct resource *resource;
1334         fres_contract_ptr_seq vreses;
1335         CORBA_Environment ev2;
1336         forb_server_id app;
1337 #define GOTO(label, error) do { ret = (error); goto label; } while(0)
1338
1339         ul_logmsg("Allocate transaction VRES '%s'[%d]\n", name, index);
1340
1341         ft = fcb_transaction_find(fcb, n);
1342         if (!ft) GOTO(err, FRES_ERR_TRANSACTION_NOT_FOUND);
1343
1344         fc = tran_contract_indx2item(ft, index);
1345         if (!fc) GOTO(err, FRSH_ERR_TOO_LARGE);
1346
1347         if (!get_fc_res_key(fc, &key))
1348                 GOTO(err, FRSH_ERR_RESOURCE_ID_INVALID);
1349         resource = fcb_resource_find(fcb, &key);
1350         if (!resource)
1351                 GOTO(err, FRES_ERR_NO_RESOURCE_MANAGER);
1352
1353         forb_get_req_source(_obj, &app);
1354         /* Find allocator for the requested VRES */
1355         ra = fcb_alloc_find(resource, &app);
1356         if (!ra) {
1357                 char str[60];
1358                 forb_server_id_to_string(str, &app, sizeof(str));
1359                 ul_logerr("No resource allocator found for %d.%d and %s\n",
1360                           resource->key.type, resource->key.id, str);
1361                 GOTO(err, FRES_ERR_NO_RESOURCE_ALLOCATOR);
1362         }
1363         fc->ra = ra;
1364
1365         if (!forb_sequence_alloc_buf(&vreses, 1))
1366                 GOTO(err, errno);
1367
1368         assert(fc->schedulable_contract);
1369         forb_sequence_elem(&vreses, 0) = fc->schedulable_contract;
1370         forb_sequence_length(&vreses) = 1;
1371         ret = fres_resource_allocator_change_vreses(ra->ra, &vreses, &ev2);
1372         ul_logerr("Err = %d\n", ret);
1373         if (forb_exception_occurred(&ev2))
1374                 GOTO(err_free, fres_forbex2err(&ev2));
1375         if (ret)
1376                 goto err_free;
1377         *id = fc->id;
1378
1379         ret = 0;
1380 err_free:
1381         forb_sequence_free_buf(&vreses, forb_no_destructor);
1382 err:
1383         return ret;
1384 }
1385
1386
1387 #if CONFIG_FCB_INET && !CONFIG_FORB_PROTO_INET_DEFAULT
1388 static int register_inet_port(forb_orb orb)
1389 {
1390         forb_port_t *port = forb_malloc(sizeof(*port));
1391         int ret;
1392         struct in_addr listen_on;
1393
1394         if (!port)
1395                 return -1;
1396         memset(port, 0, sizeof(*port));
1397         listen_on.s_addr = INADDR_ANY;
1398         ret = forb_inet_port_init(&port->desc, listen_on, 0);
1399         if (ret)
1400                 return ret;
1401         ret = forb_register_port(orb, port);
1402         return ret;
1403 }
1404 #endif
1405
1406 struct forb_fres_contract_broker_impl impl = {
1407         .negotiate_contracts = negotiate_contracts,
1408         .register_resource = register_resource,
1409         .register_allocator = register_allocator,
1410         .redistribute_spare_capacity = redistribute_spare_capacity,
1411         .get_resources = get_resources,
1412         .negotiate_transaction = negotiate_transaction,
1413         .wait_transaction = wait_transaction,
1414         .allocate_transaction_vres = allocate_transaction_vres,
1415 };
1416
1417 void peer_discovery_callback(const forb_orb peer_orb, const char *orb_id)
1418 {
1419         forb_server_id server_id;
1420         char server_id_str[sizeof(forb_server_id)*2+1];
1421
1422         forb_get_server_id(peer_orb, &server_id);
1423         forb_server_id_to_string(server_id_str, &server_id, sizeof(server_id_str));
1424 #if 0
1425         ul_logmsg("peer discovered: %s (orb_id '%s')\n", server_id_str, orb_id);
1426 #endif
1427
1428         if (orb_id == NULL)
1429                 return;
1430
1431         if (strcmp(orb_id, "org.frescor.fcb") == 0) {
1432                 fosa_abs_time_t now;
1433                 fosa_rel_time_t delay;
1434                 fosa_clock_get_time(CLOCK_REALTIME, &now);
1435                 delay = fosa_abs_time_extract_interval(start_time, now);
1436                 ul_logmsg("node joined: %s (time %ld ms)\n", server_id_str,
1437                           fosa_rel_time_to_msec(delay));
1438         }
1439 }
1440
1441 void peer_dead_callback(const forb_orb peer_orb, const char *orb_id)
1442 {
1443 }
1444
1445 static struct option long_opts[] = {
1446     { "daemon",   optional_argument, NULL, 'd' },
1447     { "loglevel", required_argument, NULL, 'l' },
1448     { 0, 0, 0, 0}
1449 };
1450
1451 static void
1452 usage(void)
1453 {
1454         printf("usage: fcb [ options ]\n");
1455         printf("  -d, --daemon [pid-file]   go to background after FORB initialization\n");
1456         printf("  -l, --loglevel <number>|<domain>=<number>,...\n");
1457 }
1458
1459 int print_log_domain(ul_log_domain_t *domain, void *context)
1460 {
1461         printf("%s = %d\n", domain->name, domain->level);
1462         return 0;
1463 }
1464
1465 int main(int argc, char *argv[])
1466 {
1467         forb_orb orb;
1468         struct fcb fcb_data;
1469         fres_contract_broker fcb;
1470         forb_executor_t executor;
1471         int ret;
1472         forb_init_attr_t attr = {
1473                 .orb_id = "org.frescor.fcb",
1474                 .peer_discovery_callback = peer_discovery_callback,
1475                 .peer_dead_callback = peer_dead_callback,
1476                 .fixed_tcp_port = FCB_TCP_PORT,
1477 #ifdef CONFIG_FORB_PROTO_INET_DEFAULT
1478                 .fixed_server_id = FCB_SERVER_ID,
1479                 .redistribute_hellos = true,
1480 #endif
1481         };
1482         int  opt;
1483
1484         while ((opt = getopt_long(argc, argv, "d::l:", &long_opts[0], NULL)) != EOF) {
1485                 switch (opt) {
1486                         case 'l':
1487                                 if (*optarg == '?') {
1488                                         ul_logreg_for_each_domain(print_log_domain, NULL);
1489                                         exit(0);
1490                                 }
1491                                 {
1492                                         int ret;
1493                                         ret = ul_log_domain_arg2levels(optarg);
1494                                         if (ret)
1495                                                 error(1, EINVAL, "Error parsing -l argument at char %d\n", ret);
1496                                 }
1497                                 break;
1498                         case 'd':
1499                                 opt_daemon = true;
1500                                 opt_pidfile = optarg;
1501                                 break;
1502                         case 'h':
1503                         /*default:*/
1504                                 usage();
1505                                 exit(opt == 'h' ? 0 : 1);
1506                 }
1507         }
1508
1509         memset(&fcb_data, 0, sizeof(fcb_data));
1510         fosa_clock_get_time(CLOCK_REALTIME, &start_time);
1511
1512         if (opt_daemon)
1513                 forb_daemon_prepare(opt_pidfile);
1514
1515         orb = forb_init(&argc, &argv, &attr);
1516         if (!orb) error(1, errno, "FORB initialization failed");
1517
1518 #if CONFIG_FCB_INET && !CONFIG_FORB_PROTO_INET_DEFAULT
1519         ret = register_inet_port(orb);
1520         if (ret) error(0, errno, "INET port registration failed");
1521 #endif
1522
1523         fcb_resource_init_root_field(&fcb_data);
1524         fcb_contract_init_root_field(&fcb_data);
1525         fcb_transaction_init_root_field(&fcb_data);
1526
1527         fcb = forb_fres_contract_broker_new(orb, &impl, &fcb_data);
1528         if (!fcb) error(1, errno, "forb_fres_contract_broker_new failed");
1529
1530         /* Prepare executor before we register the fcb reference,
1531          * so that no reuqests are lost */
1532         ret = forb_executor_init(&executor);
1533         if (ret) error(1, errno, "forb_executor_init failed");
1534
1535         ret = forb_executor_register_object(&executor, fcb);
1536         if (ret) error(1, errno, "forb_executor_register_object failed");
1537
1538         ret = forb_register_reference(fcb, fres_contract_broker_reg_name);
1539         if (ret) error(1, errno, "forb_register_reference() failed");
1540
1541         ul_logmsg("Waiting for requests\n");
1542         if (opt_daemon)
1543                 forb_daemon_ready();
1544
1545         ret = forb_executor_run(&executor);
1546         if (ret) error(1, errno, "forb_executor_run failed");
1547
1548         return 0;
1549 }