isl_point.c

   1 #include <isl_point_private.h>
   2 #include <isl_set.h>
   3 #include <isl_map_private.h>
   4 #include <isl_sample.h>
   5 #include <isl_scan.h>
   6 #include <isl_seq.h>
   7 #include <isl_dim_private.h>
   8
   9 __isl_give isl_point *isl_point_alloc(__isl_take isl_dim *dim,
  10         __isl_take isl_vec *vec)
  11 {
  12         struct isl_point *pnt;
  13
  14         if (!dim || !vec)
  15                 goto error;
  16
  17         if (vec->size > 1 + isl_dim_total(dim)) {
  18                 vec = isl_vec_cow(vec);
  19                 if (!vec)
  20                         goto error;
  21                 vec->size = 1 + isl_dim_total(dim);
  22         }
  23
  24         pnt = isl_alloc_type(dim->ctx, struct isl_point);
  25         if (!pnt)
  26                 goto error;
  27
  28         pnt->ref = 1;
  29         pnt->dim = dim;
  30         pnt->vec = vec;
  31
  32         return pnt;
  33 error:
  34         isl_dim_free(dim);
  35         isl_vec_free(vec);
  36         return NULL;
  37 }
  38
  39 __isl_give isl_point *isl_point_zero(__isl_take isl_dim *dim)
  40 {
  41         isl_vec *vec;
  42
  43         if (!dim)
  44                 return NULL;
  45         vec = isl_vec_alloc(dim->ctx, 1 + isl_dim_total(dim));
  46         if (!vec)
  47                 goto error;
  48         isl_int_set_si(vec->el[0], 1);
  49         isl_seq_clr(vec->el + 1, vec->size - 1);
  50         return isl_point_alloc(dim, vec);
  51 error:
  52         isl_dim_free(dim);
  53         return NULL;
  54 }
  55
  56 __isl_give isl_point *isl_point_dup(__isl_keep isl_point *pnt)
  57 {
  58         struct isl_point *pnt2;
  59
  60         if (!pnt)
  61                 return NULL;
  62         pnt2 = isl_point_alloc(isl_dim_copy(pnt->dim), isl_vec_copy(pnt->vec));
  63         return pnt2;
  64 }
  65
  66 __isl_give isl_point *isl_point_cow(__isl_take isl_point *pnt)
  67 {
  68         struct isl_point *pnt2;
  69         if (!pnt)
  70                 return NULL;
  71
  72         if (pnt->ref == 1)
  73                 return pnt;
  74
  75         pnt2 = isl_point_dup(pnt);
  76         isl_point_free(pnt);
  77         return pnt2;
  78 }
  79
  80 __isl_give isl_point *isl_point_copy(__isl_keep isl_point *pnt)
  81 {
  82         if (!pnt)
  83                 return NULL;
  84
  85         pnt->ref++;
  86         return pnt;
  87 }
  88
  89 void isl_point_free(__isl_take isl_point *pnt)
  90 {
  91         if (!pnt)
  92                 return;
  93
  94         if (--pnt->ref > 0)
  95                 return;
  96
  97         isl_dim_free(pnt->dim);
  98         isl_vec_free(pnt->vec);
  99         free(pnt);
 100 }
 101
 102 __isl_give isl_point *isl_point_void(__isl_take isl_dim *dim)
 103 {
 104         if (!dim)
 105                 return NULL;
 106
 107         return isl_point_alloc(dim, isl_vec_alloc(dim->ctx, 0));
 108 }
 109
 110 int isl_point_is_void(__isl_keep isl_point *pnt)
 111 {
 112         if (!pnt)
 113                 return -1;
 114
 115         return pnt->vec->size == 0;
 116 }
 117
 118 void isl_point_get_coordinate(__isl_keep isl_point *pnt,
 119         enum isl_dim_type type, int pos, isl_int *v)
 120 {
 121         if (!pnt || isl_point_is_void(pnt))
 122                 return;
 123         if (type == isl_dim_set)
 124                 pos += isl_dim_size(pnt->dim, isl_dim_param);
 125         isl_int_set(*v, pnt->vec->el[1 + pos]);
 126 }
 127
 128 __isl_give isl_point *isl_point_set_coordinate(__isl_take isl_point *pnt,
 129         enum isl_dim_type type, int pos, isl_int v)
 130 {
 131         if (!pnt || isl_point_is_void(pnt))
 132                 return pnt;
 133
 134         pnt = isl_point_cow(pnt);
 135         if (!pnt)
 136                 return NULL;
 137         pnt->vec = isl_vec_cow(pnt->vec);
 138         if (!pnt->vec)
 139                 goto error;
 140
 141         if (type == isl_dim_set)
 142                 pos += isl_dim_size(pnt->dim, isl_dim_param);
 143
 144         isl_int_set(pnt->vec->el[1 + pos], v);
 145
 146         return pnt;
 147 error:
 148         isl_point_free(pnt);
 149         return NULL;
 150 }
 151
 152 __isl_give isl_point *isl_point_add_ui(__isl_take isl_point *pnt,
 153         enum isl_dim_type type, int pos, unsigned val)
 154 {
 155         if (!pnt || isl_point_is_void(pnt))
 156                 return pnt;
 157
 158         pnt = isl_point_cow(pnt);
 159         if (!pnt)
 160                 return NULL;
 161         pnt->vec = isl_vec_cow(pnt->vec);
 162         if (!pnt->vec)
 163                 goto error;
 164
 165         if (type == isl_dim_set)
 166                 pos += isl_dim_size(pnt->dim, isl_dim_param);
 167
 168         isl_int_add_ui(pnt->vec->el[1 + pos], pnt->vec->el[1 + pos], val);
 169
 170         return pnt;
 171 error:
 172         isl_point_free(pnt);
 173         return NULL;
 174 }
 175
 176 __isl_give isl_point *isl_point_sub_ui(__isl_take isl_point *pnt,
 177         enum isl_dim_type type, int pos, unsigned val)
 178 {
 179         if (!pnt || isl_point_is_void(pnt))
 180                 return pnt;
 181
 182         pnt = isl_point_cow(pnt);
 183         if (!pnt)
 184                 return NULL;
 185         pnt->vec = isl_vec_cow(pnt->vec);
 186         if (!pnt->vec)
 187                 goto error;
 188
 189         if (type == isl_dim_set)
 190                 pos += isl_dim_size(pnt->dim, isl_dim_param);
 191
 192         isl_int_sub_ui(pnt->vec->el[1 + pos], pnt->vec->el[1 + pos], val);
 193
 194         return pnt;
 195 error:
 196         isl_point_free(pnt);
 197         return NULL;
 198 }
 199
 200 struct isl_foreach_point {
 201         struct isl_scan_callback callback;
 202         int (*fn)(__isl_take isl_point *pnt, void *user);
 203         void *user;
 204         isl_dim *dim;
 205 };
 206
 207 static int foreach_point(struct isl_scan_callback *cb, __isl_take isl_vec *sample)
 208 {
 209         struct isl_foreach_point *fp = (struct isl_foreach_point *)cb;
 210         isl_point *pnt;
 211
 212         pnt = isl_point_alloc(isl_dim_copy(fp->dim), sample);
 213
 214         return fp->fn(pnt, fp->user);
 215 }
 216
 217 int isl_set_foreach_point(__isl_keep isl_set *set,
 218         int (*fn)(__isl_take isl_point *pnt, void *user), void *user)
 219 {
 220         struct isl_foreach_point fp = { { &foreach_point }, fn, user };
 221         int i;
 222
 223         if (!set)
 224                 return -1;
 225
 226         fp.dim = isl_set_get_dim(set);
 227         if (!fp.dim)
 228                 return -1;
 229
 230         set = isl_set_copy(set);
 231         set = isl_set_cow(set);
 232         set = isl_set_make_disjoint(set);
 233         set = isl_set_compute_divs(set);
 234         if (!set)
 235                 goto error;
 236
 237         for (i = 0; i < set->n; ++i)
 238                 if (isl_basic_set_scan(isl_basic_set_copy(set->p[i]),
 239                                         &fp.callback) < 0)
 240                         goto error;
 241
 242         isl_set_free(set);
 243         isl_dim_free(fp.dim);
 244
 245         return 0;
 246 error:
 247         isl_set_free(set);
 248         isl_dim_free(fp.dim);
 249         return -1;
 250 }
 251
 252 /* Return 1 if "bmap" contains the point "point".
 253  * "bmap" is assumed to have known divs.
 254  * The point is first extended with the divs and then passed
 255  * to basic_map_contains.
 256  */
 257 int isl_basic_map_contains_point(__isl_keep isl_basic_map *bmap,
 258         __isl_keep isl_point *point)
 259 {
 260         int i;
 261         struct isl_vec *vec;
 262         unsigned dim;
 263         int contains;
 264
 265         if (!bmap || !point)
 266                 return -1;
 267         isl_assert(bmap->ctx, isl_dim_equal(bmap->dim, point->dim), return -1);
 268         if (bmap->n_div == 0)
 269                 return isl_basic_map_contains(bmap, point->vec);
 270
 271         dim = isl_basic_map_total_dim(bmap) - bmap->n_div;
 272         vec = isl_vec_alloc(bmap->ctx, 1 + dim + bmap->n_div);
 273         if (!vec)
 274                 return -1;
 275
 276         isl_seq_cpy(vec->el, point->vec->el, point->vec->size);
 277         for (i = 0; i < bmap->n_div; ++i) {
 278                 isl_seq_inner_product(bmap->div[i] + 1, vec->el,
 279                                         1 + dim + i, &vec->el[1+dim+i]);
 280                 isl_int_fdiv_q(vec->el[1+dim+i], vec->el[1+dim+i],
 281                                 bmap->div[i][0]);
 282         }
 283
 284         contains = isl_basic_map_contains(bmap, vec);
 285
 286         isl_vec_free(vec);
 287         return contains;
 288 }
 289
 290 int isl_map_contains_point(__isl_keep isl_map *map, __isl_keep isl_point *point)
 291 {
 292         int i;
 293         int found = 0;
 294
 295         if (!map || !point)
 296                 return -1;
 297
 298         map = isl_map_copy(map);
 299         map = isl_map_compute_divs(map);
 300         if (!map)
 301                 return -1;
 302
 303         for (i = 0; i < map->n; ++i) {
 304                 found = isl_basic_map_contains_point(map->p[i], point);
 305                 if (found < 0)
 306                         goto error;
 307                 if (found)
 308                         break;
 309         }
 310         isl_map_free(map);
 311
 312         return found;
 313 error:
 314         isl_map_free(map);
 315         return -1;
 316 }
 317
 318 int isl_set_contains_point(__isl_keep isl_set *set, __isl_keep isl_point *point)
 319 {
 320         return isl_map_contains_point((isl_map *)set, point);
 321 }
 322
 323 __isl_give isl_set *isl_set_from_point(__isl_take isl_point *pnt)
 324 {
 325         isl_basic_set *bset;
 326         isl_basic_set *model;
 327
 328         model = isl_basic_set_empty(isl_dim_copy(pnt->dim));
 329         bset = isl_basic_set_from_vec(isl_vec_copy(pnt->vec));
 330         bset = isl_basic_set_from_underlying_set(bset, model);
 331         isl_point_free(pnt);
 332
 333         return isl_set_from_basic_set(bset);
 334 }
 335
 336 __isl_give isl_set *isl_set_box_from_points(__isl_take isl_point *pnt1,
 337         __isl_take isl_point *pnt2)
 338 {
 339         isl_basic_set *bset;
 340         unsigned total;
 341         int i;
 342         int k;
 343         isl_int t;
 344
 345         isl_int_init(t);
 346
 347         if (!pnt1 || !pnt2)
 348                 goto error;
 349
 350         isl_assert(pnt1->dim->ctx,
 351                         isl_dim_equal(pnt1->dim, pnt2->dim), goto error);
 352
 353         if (isl_point_is_void(pnt1) && isl_point_is_void(pnt2)) {
 354                 isl_dim *dim = isl_dim_copy(pnt1->dim);
 355                 isl_point_free(pnt1);
 356                 isl_point_free(pnt2);
 357                 isl_int_clear(t);
 358                 return isl_set_empty(dim);
 359         }
 360         if (isl_point_is_void(pnt1)) {
 361                 isl_point_free(pnt1);
 362                 isl_int_clear(t);
 363                 return isl_set_from_point(pnt2);
 364         }
 365         if (isl_point_is_void(pnt2)) {
 366                 isl_point_free(pnt2);
 367                 isl_int_clear(t);
 368                 return isl_set_from_point(pnt1);
 369         }
 370
 371         total = isl_dim_total(pnt1->dim);
 372         bset = isl_basic_set_alloc_dim(isl_dim_copy(pnt1->dim), 0, 0, 2 * total);
 373
 374         for (i = 0; i < total; ++i) {
 375                 isl_int_mul(t, pnt1->vec->el[1 + i], pnt2->vec->el[0]);
 376                 isl_int_submul(t, pnt2->vec->el[1 + i], pnt1->vec->el[0]);
 377
 378                 k = isl_basic_set_alloc_inequality(bset);
 379                 if (k < 0)
 380                         goto error;
 381                 isl_seq_clr(bset->ineq[k] + 1, total);
 382                 if (isl_int_is_pos(t)) {
 383                         isl_int_set_si(bset->ineq[k][1 + i], -1);
 384                         isl_int_set(bset->ineq[k][0], pnt1->vec->el[1 + i]);
 385                 } else {
 386                         isl_int_set_si(bset->ineq[k][1 + i], 1);
 387                         isl_int_neg(bset->ineq[k][0], pnt1->vec->el[1 + i]);
 388                 }
 389                 isl_int_fdiv_q(bset->ineq[k][0], bset->ineq[k][0], pnt1->vec->el[0]);
 390
 391                 k = isl_basic_set_alloc_inequality(bset);
 392                 if (k < 0)
 393                         goto error;
 394                 isl_seq_clr(bset->ineq[k] + 1, total);
 395                 if (isl_int_is_pos(t)) {
 396                         isl_int_set_si(bset->ineq[k][1 + i], 1);
 397                         isl_int_neg(bset->ineq[k][0], pnt2->vec->el[1 + i]);
 398                 } else {
 399                         isl_int_set_si(bset->ineq[k][1 + i], -1);
 400                         isl_int_set(bset->ineq[k][0], pnt2->vec->el[1 + i]);
 401                 }
 402                 isl_int_fdiv_q(bset->ineq[k][0], bset->ineq[k][0], pnt2->vec->el[0]);
 403         }
 404
 405         bset = isl_basic_set_finalize(bset);
 406
 407         isl_point_free(pnt1);
 408         isl_point_free(pnt2);
 409
 410         isl_int_clear(t);
 411
 412         return isl_set_from_basic_set(bset);
 413 error:
 414         isl_point_free(pnt1);
 415         isl_point_free(pnt2);
 416         isl_int_clear(t);
 417         return NULL;
 418 }
 419
 420 void isl_point_print(__isl_keep isl_point *pnt, FILE *out)
 421 {
 422         int i;
 423         unsigned nparam;
 424         unsigned dim;
 425
 426         if (!pnt)
 427                 return;
 428         if (isl_point_is_void(pnt)) {
 429                 fprintf(out, "void\n");
 430                 return;
 431         }
 432
 433         nparam = isl_dim_size(pnt->dim, isl_dim_param);
 434         dim = isl_dim_size(pnt->dim, isl_dim_set);
 435         if (nparam > 0) {
 436                 fprintf(out, "[");
 437                 for (i = 0; i < nparam; ++i) {
 438                         const char *name;
 439                         if (i)
 440                                 fprintf(out, ", ");
 441                         name = isl_dim_get_name(pnt->dim, isl_dim_param, i);
 442                         if (name)
 443                                 fprintf(out, "%s = ", name);
 444                         isl_int_print(out, pnt->vec->el[1 + i], 0);
 445                         if (!isl_int_is_one(pnt->vec->el[0])) {
 446                                 fprintf(out, "/");
 447                                 isl_int_print(out, pnt->vec->el[0], 0);
 448                         }
 449                 }
 450                 fprintf(out, "] -> ");
 451         }
 452         fprintf(out, "[");
 453         for (i = 0; i < dim; ++i) {
 454                 if (i)
 455                         fprintf(out, ", ");
 456                 isl_int_print(out, pnt->vec->el[1 + nparam + i], 0);
 457                 if (!isl_int_is_one(pnt->vec->el[0])) {
 458                         fprintf(out, "/");
 459                         isl_int_print(out, pnt->vec->el[0], 0);
 460                 }
 461         }
 462         fprintf(out, "]\n");
 463 }