git.cworth.org Git - rrsolve/blob - src/rrsolve.c

   1 /* rrsolve - Simple RR solver and librr client.
   2  *
   3  * Copyright © 2003 Carl Worth
   4  *
   5  * Permission to use, copy, modify, distribute, and sell this software
   6  * and its documentation for any purpose is hereby granted without
   7  * fee, provided that the above copyright notice appear in all copies
   8  * and that both that copyright notice and this permission notice
   9  * appear in supporting documentation, and that the name of Carl Worth
  10  * not be used in advertising or publicity pertaining to distribution
  11  * of the software without specific, written prior permission.
  12  * Carl Worth makes no representations about the suitability of this
  13  * software for any purpose.  It is provided "as is" without express
  14  * or implied warranty.
  15  *
  16  * CARL WORTH DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE,
  17  * INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS, IN
  18  * NO EVENT SHALL CARL WORTH BE LIABLE FOR ANY SPECIAL, INDIRECT OR
  19  * CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS
  20  * OF USE, DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT,
  21  * NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
  22  * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  23  *
  24  * Author: Carl Worth <carl@theworths.org>
  25  */
  26
  27 #include <stdio.h>
  28 #include <stdlib.h>
  29 #include <string.h>
  30 #include <sys/time.h>
  31 #include <time.h>
  32
  33 #include "rrsolve.h"
  34
  35 #define HOST "localhost"
  36 #define PORT "5252"
  37 #define USER "rrsolve"
  38 #define GAME "game"
  39
  40 /* Tuning this can reduce excess reallocs */
  41 #define RRS_BRANCHING_FACTOR_ESTIMATE 10
  42
  43 #define RRS_STATE_SET_ROBOT(s, ri, x, y) ((s) |= (((y) << ((ri)<<3)) | ((x) << (((ri)<<3) + 4))))
  44 #define RRS_STATE_GET_ROBOT(s, ri, x, y) { (y) = ((s) >> ((ri)<<3)) & 0xf; (x) = ((s) >> (((ri)<<3) + 4)) & 0xf; }
  45
  46 static void
  47 handle_events (rr_client_t *client);
  48
  49 static rrs_state_t
  50 rrs_state_get_from_board (rr_board_t *board);
  51
  52 static void
  53 rrs_solution_print (rrs_solution_t *solution);
  54
  55 static rr_status_t
  56 solve_board (rr_board_t *board, rrs_solution_t *solution);
  57
  58 static rr_status_t
  59 find_solution_states (rr_board_t *board,
  60                       rrs_state_buf_t ***solution_states,
  61                       int *num_state_buf,
  62                       rrs_state_t *final_state);
  63
  64 static int
  65 rrs_find_new_states (rr_board_t *board,
  66                      rrs_state_buf_t **previous,
  67                      int moves,
  68                      rrs_state_buf_t *new,
  69                      rrs_state_t *solution_state);
  70
  71 static void
  72 trace_solution (rr_board_t *board,
  73                 rrs_state_buf_t **states, int moves,
  74                 rrs_state_t solution_state,
  75                 rrs_solution_t *solution);
  76
  77 char TOUGH[] = "\n"
  78 " === === === === === === === === === === === === === === === === \n"
  79 "|... ... ... ...|r.. ... ... ... ... ... ... ...|... ... ... ...|\n"
  80 "                                                     ===         \n"
  81 "|... ... ... ... ... ... ... ... ... ... ... ... ...|.rs Y.. ...|\n"
  82 "                                                                 \n"
  83 "|... ... ... ... ... .bo|... ... ... .bt|... ... ... ... ... ...|\n"
  84 "                     ===             ===                         \n"
  85 "|... ... ... ... ... ... ... ... ... ... ... ... ... ... ... ...|\n"
  86 "                                                             === \n"
  87 "|... ... ... ... ... ... ... ... ... ... ... ... ... ... ... ...|\n"
  88 "         ===                                                     \n"
  89 "|... ... .gc|... ... ... ...|.rt ... ... ... ... ... ...|.go ...|\n"
  90 " ===                         ===             ===         ===     \n"
  91 "|... ... ... ... ... ... ... ... ... ... ... .yc|... ... ... ...|\n"
  92 "     ===                     === ===                             \n"
  93 "|...|.YS ... ... ... ... ...|... ...|... ... ... ... ... ... ...|\N"
  94 "                                                 ===             \n"
  95 "|... ... ... ... ... ... ...|... ...|... ... ...|.ww ... ... ...|\n"
  96 "     ===             ===     === ===                             \n"
  97 "|... .yo|... ... ...|bbs ... ... ... ...|.bc ... ... ... ... ...|\n"
  98 "                                         ===                     \n"
  99 "|... ... ... ... ... ... ... ... ... ... ... ... ... ... ... ...|\n"
 100 " ===                                                         === \n"
 101 "|... ... ... ... ... ... ... ... ... .yt|... ... ... ... ... ...|\n"
 102 "                                     ===                 ===     \n"
 103 "|... ... ... ... ... ... .rc|... ... ... ... ... ... ... .gs|...|\n"
 104 "                         ===                                     \n"
 105 "|... ... ... ... ... ... ... ... ... ... ... ... ... ... ... g..|\n"
 106 "                                                     ===         \n"
 107 "|... ...|.gt ... ... ... ... ... ... ... ... ... ...|.ro ... ...|\n"
 108 "         ===                                                     \n"
 109 "|... ... ... ... ... ...|... ... ... ... ...|... ... ... ... ...|\n"
 110 " === === === === === === === === === === === === === === === === "
 111 /*
 112 Move #1 generated 11 new states.
 113 Move #2 generated 59 new states.
 114 Move #3 generated 216 new states.
 115 Move #4 generated 640 new states.
 116 Move #5 generated 1701 new states.
 117 Move #6 generated 4239 new states.
 118 Move #7 generated 10041 new states.
 119 Move #8 generated 22678 new states.
 120 Move #9 generated 49103 new states.
 121 Move #10 generated 102154 new states.
 122 Move #11 generated 204086 new states.
 123 Move #12 generated 391534 new states.
 124 Move #13 generated 722808 new states.
 125 Move #14 generated 1285932 new states.
 126 Move #15 generated 2204971 new states.
 127 Found solution of 16 moves in 3694.8 seconds.
 128 Traced solution in 0.052438 seconds.
 129 Solution (16 moves):
 130     Move #0: yellow east, south, west
 131 Move #3: green south, west, north
 132 Move #6: blue east, north, west, south
 133 Move #10: yellow south, east, south
 134 Move #13: green west
 135 Move #14: yellow north
 136 */
 137
 138 int
 139 main (int argc, char *argv[])
 140 {
 141     args_t args;
 142     rr_status_t status;
 143     rr_client_t *client;
 144
 145     args_parse (&args, argc, argv);
 146
 147     client = rr_client_create (args.host, args.port, args.user);
 148     if (client == NULL) {
 149         fprintf (stderr, "Failed connecting to %s:%s as %s\n",
 150                  args.host, args.port, args.user);
 151         return 1;
 152     }
 153
 154     status = rr_client_join (client, GAME);
 155     if (status == RR_STATUS_NO_GAME)
 156         status = rr_client_new (client, GAME);
 157     if (status) {
 158         fprintf (stderr, "Error joining or creating game: %s\n", rr_status_str (status));
 159         return 1;
 160     }
 161
 162     handle_events (client);
 163
 164     rr_client_destroy (client);
 165
 166     return 0;
 167 }
 168
 169 static void
 170 handle_events (rr_client_t *client)
 171 {
 172     int i;
 173     rr_status_t status;
 174     rr_notice_t *notice;
 175     rrs_solution_t solution;
 176     rr_board_t *board = NULL;
 177     char *diagram;
 178     struct timespec move_delay = { 1, 200000000l };
 179
 180     while (1) {
 181         status = rr_client_next_notice (client, &notice);
 182         if (status) {
 183             fprintf (stderr, "ERROR during rr_client_next_notice: %s\n",
 184                      rr_status_str (status));
 185             return;
 186         }
 187
 188         printf ("Received notice of type %d\n", notice->type);
 189
 190         switch  (notice->type) {
 191         case RR_NOTICE_GAMEOVER:
 192         case RR_NOTICE_JOIN:
 193             status = rr_client_show (client, &diagram);
 194             if (status) {
 195                 fprintf (stderr, "Error in rr_client_show: %s\n", rr_status_str (status));
 196                 goto DONE;
 197             }
 198             if (board == NULL)
 199                 board = rr_board_create_from_str (diagram);
 200             else
 201                 rr_board_parse (board, diagram);
 202
 203             /* XXX: Fixing the server to send a NOTICE TURN here would let me drop this code */
 204             rrs_solution_init (&solution);
 205             solve_board (board, &solution);
 206             rr_client_bid (client, solution.num_moves);
 207             break;
 208         case RR_NOTICE_TURN:
 209             rr_board_set_goal_target (board, notice->u.target);
 210             rrs_solution_init (&solution);
 211             solve_board (board, &solution);
 212             rr_client_bid (client, solution.num_moves);
 213             break;
 214         case RR_NOTICE_ACTIVATE:
 215             for (i = 0; i < solution.num_moves; i++) {
 216                 status = rr_client_move (client,
 217                                          solution.move[i].robot,
 218                                          solution.move[i].dir);
 219                 if (status) {
 220                     rr_client_message (client, "Drat, looks like I was wrong.");
 221                     rr_client_pass (client);
 222                     break;
 223                 }
 224                 nanosleep (&move_delay, NULL);
 225             }
 226             rrs_solution_fini (&solution);
 227             return;
 228             break;
 229         case RR_NOTICE_ABANDON:
 230             rr_client_abandon (client);
 231             break;
 232         case RR_NOTICE_NOBID:
 233             rr_client_nobid (client);
 234             break;
 235         case RR_NOTICE_POSITION:
 236             rr_board_position_robot (board,
 237                                      notice->u.position.robot,
 238                                      notice->u.position.x,
 239                                      notice->u.position.y);
 240             break;
 241         case RR_NOTICE_GAMESTATE:
 242             if (notice->u.gamestate == RR_GAMESTATE_SHOW) {
 243                 if (solution.num_moves) {
 244                     printf ("My solution (%d moves):", solution.num_moves);
 245                     rrs_solution_print (&solution);
 246                 }
 247             }
 248             break;
 249         case RR_NOTICE_GAME:
 250         case RR_NOTICE_USER:
 251         case RR_NOTICE_QUIT:
 252         case RR_NOTICE_DISPOSE:
 253         case RR_NOTICE_MESSAGE:
 254         case RR_NOTICE_WATCH:
 255         case RR_NOTICE_PART:
 256         case RR_NOTICE_BID:
 257         case RR_NOTICE_REVOKE:
 258         case RR_NOTICE_TIMER:
 259         case RR_NOTICE_ACTIVE:
 260         case RR_NOTICE_MOVE:
 261         case RR_NOTICE_UNDO:
 262         case RR_NOTICE_RESET:
 263         case RR_NOTICE_SCORE:
 264             /* Ignore these notices */
 265             break;
 266         }
 267     }
 268
 269   DONE:
 270     if (board)
 271         rr_board_destroy (board);
 272 }
 273
 274 static void
 275 rrs_solution_print (rrs_solution_t *solution)
 276 {
 277     int i;
 278     rr_robot_t last_robot;
 279     rrs_move_t *move;
 280
 281     last_robot = RR_ROBOT_NONE;
 282     for (i=0; i < solution->num_moves; i++) {
 283         move = &solution->move[i];
 284         if (move->robot == last_robot)
 285             printf (", %s", rr_direction_str (move->dir));
 286         else
 287             printf ("\n Move #%d: %s %s",
 288                     i, rr_robot_str (move->robot), rr_direction_str (move->dir));
 289         last_robot = move->robot;
 290     }
 291     printf ("\n");
 292 }
 293
 294 static rrs_state_t
 295 rrs_state_get_from_board (rr_board_t *board)
 296 {
 297     int i;
 298     int x, y;
 299     rrs_state_t state;
 300
 301     state = 0;
 302
 303     for (i=0; i < RR_NUM_ROBOTS; i++) {
 304         rr_board_find_robot (board, rr_robot_from_idx (i), &x, &y);
 305         RRS_STATE_SET_ROBOT (state, i, x, y);
 306     }
 307
 308     return state;
 309 }
 310
 311 static void
 312 rrs_state_set_board (rrs_state_t state, rr_board_t *board)
 313 {
 314     int i;
 315     int x, y;
 316
 317     for (i=0; i < RR_NUM_ROBOTS; i++) {
 318         RRS_STATE_GET_ROBOT (state, i, x, y);
 319         rr_board_position_robot (board, rr_robot_from_idx (i), x, y);
 320     }
 321
 322 }
 323
 324 static rr_status_t
 325 solve_board (rr_board_t *board, rrs_solution_t *solution)
 326 {
 327     rr_status_t status;
 328     int i, moves;
 329     rrs_state_t solution_state;
 330     rrs_state_buf_t **states;
 331     struct timeval tv_start, tv_end;
 332
 333     if (rr_board_solved (board)) {
 334         printf ("Board is solved to begin with.\n");
 335         return RR_STATUS_SUCCESS;
 336     }
 337
 338     printf ("Now trying to solve:");
 339     puts (rr_board_to_str (board));
 340
 341     gettimeofday (&tv_start, NULL);
 342
 343     status = find_solution_states (board, &states, &moves, &solution_state);
 344     if (status)
 345         return status;
 346
 347     gettimeofday (&tv_end, NULL);
 348
 349     if (moves < 0) {
 350         printf ("It seems impossible.\n");
 351     } else {
 352         printf ("Found solution of %d moves in %g seconds.\n",
 353                 moves,
 354                 tv_end.tv_sec - tv_start.tv_sec
 355                 + (tv_end.tv_usec - tv_start.tv_usec) / 1e6);
 356
 357         gettimeofday (&tv_start, NULL);
 358
 359         trace_solution (board, states, moves, solution_state, solution);
 360
 361         gettimeofday (&tv_end, NULL);
 362
 363         printf ("Traced solution in %g seconds.\n",
 364                 tv_end.tv_sec - tv_start.tv_sec
 365                 + (tv_end.tv_usec - tv_start.tv_usec) / 1e6);
 366     }
 367
 368     for (i=0; i <= moves; i++) {
 369         rrs_state_buf_destroy (states[i]);
 370         states[i] = NULL;
 371     }
 372
 373     free (states);
 374
 375     return RR_STATUS_SUCCESS;
 376 }
 377
 378 static int
 379 rrs_state_connected (rrs_state_t a, rrs_state_t b,
 380                      rr_robot_t *robot, rr_direction_t *dir)
 381 {
 382     int i;
 383     int nib;
 384     rrs_state_t diff, mask;
 385     int shift, delta;
 386
 387     diff = a ^ b;
 388
 389     nib = -1;
 390     for (i=0; i < 8; i++) {
 391         if (diff & 0xf) {
 392             if (nib > 0)
 393                 return 0;
 394             else
 395                 nib = i;
 396         }
 397         diff >>= 4;
 398     }
 399
 400     switch (nib) {
 401     case 0:
 402     case 1:
 403         *robot = RR_ROBOT_BLUE;
 404         break;
 405     case 2:
 406     case 3:
 407         *robot = RR_ROBOT_GREEN;
 408         break;
 409     case 4:
 410     case 5:
 411         *robot = RR_ROBOT_RED;
 412         break;
 413     case 6:
 414     case 7:
 415         *robot = RR_ROBOT_YELLOW;
 416         break;
 417     }
 418
 419     shift = 4 * nib;
 420     mask = 0xf << shift;
 421     delta = ((b & mask) >> shift) - ((a & mask) >> shift);
 422
 423     if (nib % 2)
 424         if (delta < 0)
 425             *dir = RR_DIRECTION_WEST;
 426         else
 427             *dir = RR_DIRECTION_EAST;
 428     else
 429         if (delta < 0)
 430             *dir = RR_DIRECTION_NORTH;
 431         else
 432             *dir = RR_DIRECTION_SOUTH;
 433
 434     return 1;
 435 }
 436
 437 static void
 438 trace_solution (rr_board_t *board,
 439                 rrs_state_buf_t **states, int moves,
 440                 rrs_state_t solution_state,
 441                 rrs_solution_t *solution)
 442 {
 443     rr_status_t status;
 444     int i, j;
 445     rrs_state_buf_t *buf;
 446     rr_robot_t robot;
 447     rr_direction_t dir;
 448
 449     for (i = moves-1; i >= 0; i--) {
 450         buf = states[i];
 451         for (j = 0; j < buf->num_states; j++) {
 452             if (rrs_state_connected (buf->state[j], solution_state,
 453                                      &robot, &dir)) {
 454                 rrs_state_set_board (buf->state[j], board);
 455                 status = rr_board_move (board, robot, dir);
 456                 if (status == RR_STATUS_SUCCESS) {
 457                     if (rrs_state_get_from_board (board) == solution_state) {
 458                         rrs_solution_prepend (solution, robot, dir);
 459                         solution_state = buf->state[j];
 460                         goto NEXT_MOVE;
 461                     }
 462                 }
 463             }
 464         }
 465         fprintf (stderr, "ERROR: Failed to trace solution backwards to 0x%x at move %d\n",
 466                  solution_state, i+1);
 467         break;
 468       NEXT_MOVE:
 469         ;
 470     }
 471 }
 472
 473 static rr_status_t
 474 find_solution_states (rr_board_t *board,
 475                       rrs_state_buf_t ***solution_states,
 476                       int *num_state_buf,
 477                       rrs_state_t *final_state)
 478 {
 479     int solved, moves;
 480     rrs_state_t initial;
 481     rrs_state_buf_t **states, **new_states;
 482
 483     states = malloc (sizeof (rrs_state_buf_t *));
 484     if (states == NULL)
 485         return RR_STATUS_NO_MEMORY;
 486
 487     initial = rrs_state_get_from_board (board);
 488
 489     states[0] = rrs_state_buf_create (1);
 490     if (states[0] == NULL)
 491         return RR_STATUS_NO_MEMORY;
 492     rrs_state_buf_add (states[0], initial);
 493
 494     moves = 0;
 495     while (1) {
 496         moves++;
 497
 498         new_states = realloc (states, (moves + 1) * sizeof (rrs_state_buf_t *));
 499         if (new_states == NULL)
 500             return RR_STATUS_NO_MEMORY;
 501
 502         states = new_states;
 503         states[moves] = rrs_state_buf_create (RRS_BRANCHING_FACTOR_ESTIMATE
 504                                               * states[moves-1]->num_states);
 505         if (states[moves] == NULL)
 506             return RR_STATUS_NO_MEMORY;
 507
 508         solved = rrs_find_new_states (board, states, moves-1, states[moves], final_state);
 509
 510         if (solved)
 511             break;
 512
 513         if (states[moves]->num_states == 0) {
 514             printf ("Can't make any further progress after %d moves.\n", moves);
 515             moves = -1;
 516             break;
 517         } else {
 518             printf ("Move #%d generated %d new states.\n",
 519                     moves, states[moves]->num_states);
 520         }
 521     }
 522
 523     *num_state_buf = moves;
 524     *solution_states = states;
 525
 526     return RR_STATUS_SUCCESS;
 527 }
 528
 529 static int
 530 state_has_been_seen (rrs_state_buf_t **previous,
 531                      int moves,
 532                      rrs_state_t state)
 533 {
 534     int i;
 535
 536     for (i=0; i <= moves; i++)
 537         if (rrs_state_buf_contains (previous[i], state))
 538             return 1;
 539     return 0;
 540 }
 541
 542 static int
 543 rrs_find_new_states (rr_board_t *board,
 544                      rrs_state_buf_t **previous,
 545                      int moves,
 546                      rrs_state_buf_t *new,
 547                      rrs_state_t *solution_state)
 548 {
 549     int i, ri;
 550     rr_direction_t dir;
 551     rrs_state_t state, new_state;
 552     rrs_state_buf_t *initial;
 553     rr_status_t status;
 554     rr_robot_t robot;
 555
 556     initial = previous[moves];
 557
 558     for (i = 0; i < initial->num_states; i++) {
 559         state = initial->state[i];
 560
 561         rrs_state_set_board (state, board);
 562         for (ri = 0; ri < RR_NUM_ROBOTS; ri++) {
 563             robot = rr_robot_from_idx (ri);
 564             for (dir = RR_DIRECTION_NORTH; dir <= RR_DIRECTION_EAST; dir++) {
 565                 status = rr_board_move (board, robot, dir);
 566                 if (status == RR_STATUS_SUCCESS) {
 567                     new_state = rrs_state_get_from_board (board);
 568                     if (! state_has_been_seen (previous, moves, new_state)) {
 569                         rrs_state_buf_add_sorted (new, new_state);
 570                         if (rr_board_solved (board)) {
 571                             *solution_state = new_state;
 572                             return 1;
 573                         }
 574                     }
 575                     rr_board_undo (board);
 576                 }
 577             }
 578         }
 579     }
 580
 581     return 0;
 582 }
 583