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         switch  (notice->type) {
 189         case RR_NOTICE_GAMEOVER:
 190         case RR_NOTICE_JOIN:
 191             status = rr_client_show (client, &diagram);
 192             if (status) {
 193                 fprintf (stderr, "Error in rr_client_show: %s\n", rr_status_str (status));
 194                 goto DONE;
 195             }
 196             if (board == NULL)
 197                 board = rr_board_create_from_str (diagram);
 198             else
 199                 rr_board_parse (board, diagram);
 200
 201             /* XXX: Fixing the server to send a NOTICE TURN here would let me drop this code */
 202             rrs_solution_init (&solution);
 203             solve_board (board, &solution);
 204             rr_client_bid (client, solution.num_moves);
 205             break;
 206         case RR_NOTICE_TURN:
 207             rr_board_set_goal_target (board, notice->u.target);
 208             rrs_solution_init (&solution);
 209             solve_board (board, &solution);
 210             rr_client_bid (client, solution.num_moves);
 211             break;
 212         case RR_NOTICE_ACTIVATE:
 213             for (i = 0; i < solution.num_moves; i++) {
 214                 status = rr_client_move (client,
 215                                          solution.move[i].robot,
 216                                          solution.move[i].dir);
 217                 if (status) {
 218                     rr_client_message (client, "Drat, looks like I was wrong.");
 219                     rr_client_pass (client);
 220                     break;
 221                 }
 222                 nanosleep (&move_delay, NULL);
 223             }
 224             rrs_solution_fini (&solution);
 225             break;
 226         case RR_NOTICE_ABANDON:
 227             rr_client_abandon (client);
 228             break;
 229         case RR_NOTICE_NOBID:
 230             rr_client_nobid (client);
 231             break;
 232         case RR_NOTICE_POSITION:
 233             rr_board_position_robot (board,
 234                                      notice->u.position.robot,
 235                                      notice->u.position.x,
 236                                      notice->u.position.y);
 237             break;
 238         case RR_NOTICE_GAMESTATE:
 239             if (notice->u.gamestate == RR_GAMESTATE_SHOW) {
 240                 if (solution.num_moves) {
 241                     printf ("My solution (%d moves):", solution.num_moves);
 242                     rrs_solution_print (&solution);
 243                 }
 244             }
 245             break;
 246         case RR_NOTICE_GAME:
 247         case RR_NOTICE_USER:
 248         case RR_NOTICE_QUIT:
 249         case RR_NOTICE_DISPOSE:
 250         case RR_NOTICE_MESSAGE:
 251         case RR_NOTICE_WATCH:
 252         case RR_NOTICE_PART:
 253         case RR_NOTICE_BID:
 254         case RR_NOTICE_REVOKE:
 255         case RR_NOTICE_TIMER:
 256         case RR_NOTICE_ACTIVE:
 257         case RR_NOTICE_MOVE:
 258         case RR_NOTICE_UNDO:
 259         case RR_NOTICE_RESET:
 260         case RR_NOTICE_SCORE:
 261             /* Ignore these notices */
 262             break;
 263         }
 264     }
 265
 266   DONE:
 267     if (board)
 268         rr_board_destroy (board);
 269 }
 270
 271 static void
 272 rrs_solution_print (rrs_solution_t *solution)
 273 {
 274     int i;
 275     rr_robot_t last_robot;
 276     rrs_move_t *move;
 277
 278     last_robot = RR_ROBOT_NONE;
 279     for (i=0; i < solution->num_moves; i++) {
 280         move = &solution->move[i];
 281         if (move->robot == last_robot)
 282             printf (", %s", rr_direction_str (move->dir));
 283         else
 284             printf ("\n Move #%d: %s %s",
 285                     i, rr_robot_str (move->robot), rr_direction_str (move->dir));
 286         last_robot = move->robot;
 287     }
 288     printf ("\n");
 289 }
 290
 291 static rrs_state_t
 292 rrs_state_get_from_board (rr_board_t *board)
 293 {
 294     int i;
 295     int x, y;
 296     rrs_state_t state;
 297
 298     state = 0;
 299
 300     for (i=0; i < RR_NUM_ROBOTS; i++) {
 301         rr_board_find_robot (board, rr_robot_from_idx (i), &x, &y);
 302         RRS_STATE_SET_ROBOT (state, i, x, y);
 303     }
 304
 305     return state;
 306 }
 307
 308 static void
 309 rrs_state_set_board (rrs_state_t state, rr_board_t *board)
 310 {
 311     int i;
 312     int x, y;
 313
 314     for (i=0; i < RR_NUM_ROBOTS; i++) {
 315         RRS_STATE_GET_ROBOT (state, i, x, y);
 316         rr_board_position_robot (board, rr_robot_from_idx (i), x, y);
 317     }
 318
 319 }
 320
 321 static rr_status_t
 322 solve_board (rr_board_t *board, rrs_solution_t *solution)
 323 {
 324     rr_status_t status;
 325     int i, moves;
 326     rrs_state_t solution_state;
 327     rrs_state_buf_t **states;
 328     struct timeval tv_start, tv_end;
 329
 330     if (rr_board_solved (board)) {
 331         printf ("Board is solved to begin with.\n");
 332         return RR_STATUS_SUCCESS;
 333     }
 334
 335     printf ("Now trying to solve:");
 336     puts (rr_board_to_str (board));
 337
 338     gettimeofday (&tv_start, NULL);
 339
 340     status = find_solution_states (board, &states, &moves, &solution_state);
 341     if (status)
 342         return status;
 343
 344     gettimeofday (&tv_end, NULL);
 345
 346     if (moves < 0) {
 347         printf ("It seems impossible.\n");
 348     } else {
 349         printf ("Found solution of %d moves in %g seconds.\n",
 350                 moves,
 351                 tv_end.tv_sec - tv_start.tv_sec
 352                 + (tv_end.tv_usec - tv_start.tv_usec) / 1e6);
 353
 354         gettimeofday (&tv_start, NULL);
 355
 356         trace_solution (board, states, moves, solution_state, solution);
 357
 358         gettimeofday (&tv_end, NULL);
 359
 360         printf ("Traced solution in %g seconds.\n",
 361                 tv_end.tv_sec - tv_start.tv_sec
 362                 + (tv_end.tv_usec - tv_start.tv_usec) / 1e6);
 363     }
 364
 365     for (i=0; i <= moves; i++) {
 366         rrs_state_buf_destroy (states[i]);
 367         states[i] = NULL;
 368     }
 369
 370     free (states);
 371
 372     return RR_STATUS_SUCCESS;
 373 }
 374
 375 static int
 376 rrs_state_connected (rrs_state_t a, rrs_state_t b,
 377                      rr_robot_t *robot, rr_direction_t *dir)
 378 {
 379     int i;
 380     int nib;
 381     rrs_state_t diff, mask;
 382     int shift, delta;
 383
 384     diff = a ^ b;
 385
 386     nib = -1;
 387     for (i=0; i < 8; i++) {
 388         if (diff & 0xf) {
 389             if (nib > 0)
 390                 return 0;
 391             else
 392                 nib = i;
 393         }
 394         diff >>= 4;
 395     }
 396
 397     switch (nib) {
 398     case 0:
 399     case 1:
 400         *robot = RR_ROBOT_BLUE;
 401         break;
 402     case 2:
 403     case 3:
 404         *robot = RR_ROBOT_GREEN;
 405         break;
 406     case 4:
 407     case 5:
 408         *robot = RR_ROBOT_RED;
 409         break;
 410     case 6:
 411     case 7:
 412         *robot = RR_ROBOT_YELLOW;
 413         break;
 414     }
 415
 416     shift = 4 * nib;
 417     mask = 0xf << shift;
 418     delta = ((b & mask) >> shift) - ((a & mask) >> shift);
 419
 420     if (nib % 2)
 421         if (delta < 0)
 422             *dir = RR_DIRECTION_WEST;
 423         else
 424             *dir = RR_DIRECTION_EAST;
 425     else
 426         if (delta < 0)
 427             *dir = RR_DIRECTION_NORTH;
 428         else
 429             *dir = RR_DIRECTION_SOUTH;
 430
 431     return 1;
 432 }
 433
 434 static void
 435 trace_solution (rr_board_t *board,
 436                 rrs_state_buf_t **states, int moves,
 437                 rrs_state_t solution_state,
 438                 rrs_solution_t *solution)
 439 {
 440     rr_status_t status;
 441     int i, j;
 442     rrs_state_buf_t *buf;
 443     rr_robot_t robot;
 444     rr_direction_t dir;
 445
 446     for (i = moves-1; i >= 0; i--) {
 447         buf = states[i];
 448         for (j = 0; j < buf->num_states; j++) {
 449             if (rrs_state_connected (buf->state[j], solution_state,
 450                                      &robot, &dir)) {
 451                 rrs_state_set_board (buf->state[j], board);
 452                 status = rr_board_move (board, robot, dir);
 453                 if (status == RR_STATUS_SUCCESS) {
 454                     if (rrs_state_get_from_board (board) == solution_state) {
 455                         rrs_solution_prepend (solution, robot, dir);
 456                         solution_state = buf->state[j];
 457                         goto NEXT_MOVE;
 458                     }
 459                 }
 460             }
 461         }
 462         fprintf (stderr, "ERROR: Failed to trace solution backwards to 0x%x at move %d\n",
 463                  solution_state, i+1);
 464         break;
 465       NEXT_MOVE:
 466         ;
 467     }
 468 }
 469
 470 static rr_status_t
 471 find_solution_states (rr_board_t *board,
 472                       rrs_state_buf_t ***solution_states,
 473                       int *num_state_buf,
 474                       rrs_state_t *final_state)
 475 {
 476     int solved, moves;
 477     rrs_state_t initial;
 478     rrs_state_buf_t **states, **new_states;
 479
 480     states = malloc (sizeof (rrs_state_buf_t *));
 481     if (states == NULL)
 482         return RR_STATUS_NO_MEMORY;
 483
 484     initial = rrs_state_get_from_board (board);
 485
 486     states[0] = rrs_state_buf_create (1);
 487     if (states[0] == NULL)
 488         return RR_STATUS_NO_MEMORY;
 489     rrs_state_buf_add (states[0], initial);
 490
 491     moves = 0;
 492     while (1) {
 493         moves++;
 494
 495         new_states = realloc (states, (moves + 1) * sizeof (rrs_state_buf_t *));
 496         if (new_states == NULL)
 497             return RR_STATUS_NO_MEMORY;
 498
 499         states = new_states;
 500         states[moves] = rrs_state_buf_create (RRS_BRANCHING_FACTOR_ESTIMATE
 501                                               * states[moves-1]->num_states);
 502         if (states[moves] == NULL)
 503             return RR_STATUS_NO_MEMORY;
 504
 505         solved = rrs_find_new_states (board, states, moves-1, states[moves], final_state);
 506
 507         if (solved)
 508             break;
 509
 510         if (states[moves]->num_states == 0) {
 511             printf ("Can't make any further progress after %d moves.\n", moves);
 512             moves = -1;
 513             break;
 514         } else {
 515             printf ("Move #%d generated %d new states.\n",
 516                     moves, states[moves]->num_states);
 517         }
 518     }
 519
 520     *num_state_buf = moves;
 521     *solution_states = states;
 522
 523     return RR_STATUS_SUCCESS;
 524 }
 525
 526 static int
 527 state_has_been_seen (rrs_state_buf_t **previous,
 528                      int moves,
 529                      rrs_state_t state)
 530 {
 531     int i;
 532
 533     for (i=0; i <= moves; i++)
 534         if (rrs_state_buf_contains (previous[i], state))
 535             return 1;
 536     return 0;
 537 }
 538
 539 static int
 540 rrs_find_new_states (rr_board_t *board,
 541                      rrs_state_buf_t **previous,
 542                      int moves,
 543                      rrs_state_buf_t *new,
 544                      rrs_state_t *solution_state)
 545 {
 546     int i, ri;
 547     rr_direction_t dir;
 548     rrs_state_t state, new_state;
 549     rrs_state_buf_t *initial;
 550     rr_status_t status;
 551     rr_robot_t robot;
 552
 553     initial = previous[moves];
 554
 555     for (i = 0; i < initial->num_states; i++) {
 556         state = initial->state[i];
 557
 558         rrs_state_set_board (state, board);
 559         for (ri = 0; ri < RR_NUM_ROBOTS; ri++) {
 560             robot = rr_robot_from_idx (ri);
 561             for (dir = RR_DIRECTION_NORTH; dir <= RR_DIRECTION_EAST; dir++) {
 562                 status = rr_board_move (board, robot, dir);
 563                 if (status == RR_STATUS_SUCCESS) {
 564                     new_state = rrs_state_get_from_board (board);
 565                     if (! state_has_been_seen (previous, moves, new_state)) {
 566                         rrs_state_buf_add_sorted (new, new_state);
 567                         if (rr_board_solved (board)) {
 568                             *solution_state = new_state;
 569                             return 1;
 570                         }
 571                     }
 572                     rr_board_undo (board);
 573                 }
 574             }
 575         }
 576     }
 577
 578     return 0;
 579 }
 580