Games/Moria3D/Source/Moveing.c

   1 /****************************************************************************
   2 *                                                                           *
   3 * Moveing.c                                                          970319 *
   4 *                                                                           *
   5 * Move Player around                                                        *
   6 *                                                                           *
   7 ****************************************************************************/
   8
   9 #include <stdio.h>
  10 #include <string.h>
  11 #include <stdlib.h>
  12 #include <intuition/intuition.h>
  13 #include <proto/exec.h>
  14
  15 #include "MyTypes.h"
  16 #include "Moveing.h"
  17 #include "Gfx.h"
  18 #include "Level.h"
  19 #include "MyMath.h"
  20
  21 int32 XMove=0,YMove=0,ZMove=0;
  22 int32 Button1,Button2;
  23
  24 struct MsgPort * WindowPort;
  25
  26 int32 MouseX=0,MouseY=0;
  27 fix   SpeedUp   = DefSpeedUp;
  28 fix   SpeedDown = DefSpeedDown;
  29 int16 Pause = !(0==0);
  30
  31 void TurnPlayer(pBot MyPlayer)
  32 {
  33     Matrix M;
  34     Vct    a,b;
  35
  36     #define COS1 0.0038053
  37     #define SIN  0.0871557
  38
  39     /*
  40     printf("%f %f %f , %f %f %f , %f %f %f\n",MyPlayer->Direction.a.x,MyPlayer->Direction.a.y,MyPlayer->Direction.a.z,
  41                                               MyPlayer->Direction.b.x,MyPlayer->Direction.b.y,MyPlayer->Direction.b.z,
  42                                               MyPlayer->Direction.c.x,MyPlayer->Direction.c.y,MyPlayer->Direction.c.z);
  43     */
  44     /* Turn sideways */
  45
  46     VctMulFix(&MyPlayer->Direction.a,1.0-COS1*XMove*XMove,&a);
  47     VctMulFix(&MyPlayer->Direction.c,SIN*XMove,&b);
  48     VctAdd(&a,&b,&M.a);
  49
  50     M.b.x = MyPlayer->Direction.b.x;
  51     M.b.y = MyPlayer->Direction.b.y;
  52     M.b.z = MyPlayer->Direction.b.z;
  53
  54     VctMulFix(&MyPlayer->Direction.a,-SIN*XMove,&a);
  55     VctMulFix(&MyPlayer->Direction.c,1-COS1*XMove*XMove,&b);
  56     VctAdd(&a,&b,&M.c);
  57
  58     /* Turn Upwards */
  59
  60     MyPlayer->Direction.a.x = M.a.x;
  61     MyPlayer->Direction.a.y = M.a.y;
  62     MyPlayer->Direction.a.z = M.a.z;
  63
  64     VctMulFix(&M.b,1-COS1*YMove*YMove,&a);
  65     VctMulFix(&M.c,SIN*YMove,&b);
  66     VctAdd(&a,&b,&MyPlayer->Direction.b);
  67
  68     VctMulFix(&M.b,-SIN*YMove,&a);
  69     VctMulFix(&M.c,1-COS1*YMove*YMove,&b);
  70     VctAdd(&a,&b,&MyPlayer->Direction.c);
  71
  72
  73     /* Turn Around */
  74
  75     VctMulFix(&MyPlayer->Direction.a,1.0-COS1*ZMove*ZMove,&a);
  76     VctMulFix(&MyPlayer->Direction.b,SIN*ZMove,&b);
  77     VctAdd(&a,&b,&M.a);
  78
  79     VctMulFix(&MyPlayer->Direction.a,-SIN*ZMove,&a);
  80     VctMulFix(&MyPlayer->Direction.b,1-COS1*ZMove*ZMove,&b);
  81     VctAdd(&a,&b,&M.b);
  82
  83     MyPlayer->Direction.a.x = M.a.x;
  84     MyPlayer->Direction.a.y = M.a.y;
  85     MyPlayer->Direction.a.z = M.a.z;
  86
  87     MyPlayer->Direction.b.x = M.b.x;
  88     MyPlayer->Direction.b.y = M.b.y;
  89     MyPlayer->Direction.b.z = M.b.z;
  90
  91     /*
  92     printf("%f %f %f , %f %f %f , %f %f %f\n",MyPlayer->Direction.a.x,MyPlayer->Direction.a.y,MyPlayer->Direction.a.z,
  93                                               MyPlayer->Direction.b.x,MyPlayer->Direction.b.y,MyPlayer->Direction.b.z,
  94                                               MyPlayer->Direction.c.x,MyPlayer->Direction.c.y,MyPlayer->Direction.c.z);
  95     */
  96 }
  97
  98 void MoveForward(pBot MyPlayer)
  99 {
 100     Vct a;
 101
 102     VctMulFix(&MyPlayer->Direction.c,SpeedUp,&a);
 103     VctAdd(&MyPlayer->Speed,&a,&MyPlayer->Speed);
 104 }
 105
 106 void MoveBackward(pBot MyPlayer)
 107 {
 108     Vct a;
 109
 110     VctMulFix(&MyPlayer->Direction.c,-SpeedUp,&a);
 111     VctAdd(&MyPlayer->Speed,&a,&MyPlayer->Speed);
 112 }
 113
 114 int16 CheckCollision(pBot MyPlayer)
 115 {
 116     Vct   a;
 117     int16 x;
 118     fix   d;
 119     pBot  MyBot,NextBot;
 120     int16 Death= !(0==0);
 121
 122     /*
 123     printf("\n%d\n",MyPlayer->Cube);
 124     */
 125
 126     /* Check Bot */
 127
 128     MyBot=MyPlayer->Cube->FirstBot;
 129
 130     while ((MyBot != 0) && (!Death))
 131     {
 132         NextBot = MyBot->Next;
 133
 134         if (MyBot != MyPlayer)
 135         {
 136             VctSub(&MyBot->Pos,&MyPlayer->Pos,&a);
 137             d= VctLength(&a);
 138
 139             if (d == 0)
 140             {
 141                 printf("Tele Frag\n");
 142             }
 143             else if (d<MyPlayer->Size+MyBot->Size) /* Do we hit it ? */
 144             {
 145                 d=(MyPlayer->Size+MyBot->Size-d) / d;
 146
 147                 if ((MyBot->Type & BotPush) != 0)
 148                 {
 149                     /* Push Player */
 150
 151                     VctMulFix(&a,d,&a);
 152                     VctSub(&MyPlayer->Speed,&a,&MyPlayer->Speed);
 153                 }
 154                 if ((MyPlayer->Type & BotPickup) != 0)
 155                 {
 156                     /* Pickup Bot */
 157
 158                     if ((MyBot->Type & BotPlayer) != 0) /* Only Player can Pickup */
 159                     {
 160                         /* Resolve Bot from Cube */
 161
 162                         if (MyPlayer->Next != 0)
 163                         {
 164                             MyPlayer->Next->Prev = MyPlayer->Prev;
 165                         }
 166                         if (MyPlayer->Prev != 0)
 167                         {
 168                             MyPlayer->Prev->Next = MyPlayer->Next;
 169                         }
 170                         else
 171                         {
 172                             MyPlayer->Cube->FirstBot = MyPlayer->Next;
 173                         }
 174
 175                         /* Resolve Bot from Abs Chain */
 176
 177                         if (MyPlayer->AbsNext != 0)
 178                         {
 179                             MyPlayer->AbsNext->AbsPrev = MyPlayer->AbsPrev;
 180                         }
 181                         if (MyPlayer->AbsPrev != 0)
 182                         {
 183                             MyPlayer->AbsPrev->AbsNext = MyPlayer->AbsNext;
 184                         }
 185
 186                         /* Insert Player into unused chain */
 187
 188                         MyPlayer->Next = FirstUnusedBot;
 189                         MyPlayer->Prev = 0;
 190
 191                         if (MyPlayer->Next != 0)
 192                         {
 193                             MyPlayer->Next->Prev = MyPlayer;
 194                         }
 195
 196                         /* Add Thing to Bot */
 197
 198                         if ((MyPlayer->Type & BotRing) != 0)
 199                         {
 200                             printf("Ring collected\n");
 201                             MyBot->NumRings++;
 202                         }
 203
 204                         Death = (0==0);
 205                     }
 206                 }
 207             }
 208         }
 209
 210         MyBot = NextBot;
 211     }
 212
 213     if (!Death)
 214     {
 215         /* Check Sides */
 216
 217         for (x=0;x<6;x++)
 218         {
 219             /*
 220             printf("Pos %f %f %f\n",MyPlayer->Pos.x,MyPlayer->Pos.y,MyPlayer->Pos.z);
 221             */
 222
 223             VctSub(&MyPlayer->Pos,MyPlayer->Cube->Sides[x].Pnts[0],&a);
 224
 225             /*
 226             printf("Pos %f %f %f\n",a.x,a.y,a.z);
 227             printf("Vct %f %f %f\n",MyPlayer->Cube->Sides[x].Rev.a.z,
 228                                     MyPlayer->Cube->Sides[x].Rev.b.z,
 229                                     MyPlayer->Cube->Sides[x].Rev.c.z);
 230             */
 231
 232             d=a.x * MyPlayer->Cube->Sides[x].Rev.a.z
 233              +a.y * MyPlayer->Cube->Sides[x].Rev.b.z
 234              +a.z * MyPlayer->Cube->Sides[x].Rev.c.z;
 235
 236             /*
 237             printf("%d %f\n",x,d);
 238             */
 239             if (MyPlayer->Cube->Cubes[x] != 0)
 240             {
 241                 if (d<0)
 242                 {
 243                     /* Resolve Bot from chains */
 244
 245                     if (MyPlayer->Next != 0)
 246                     {
 247                         MyPlayer->Next->Prev = MyPlayer->Prev;
 248                     }
 249                     if (MyPlayer->Prev != 0)
 250                     {
 251                         MyPlayer->Prev->Next = MyPlayer->Next;
 252                     }
 253                     else
 254                     {
 255                         MyPlayer->Cube->FirstBot = MyPlayer->Next;
 256                     }
 257
 258                     /* Change to new cube */
 259
 260                     MyPlayer->Cube=MyPlayer->Cube->Cubes[x];
 261
 262                     /* Insert into chain */
 263
 264                     MyPlayer->Next = MyPlayer->Cube->FirstBot;
 265                     MyPlayer->Cube->FirstBot = MyPlayer;
 266                     MyPlayer->Prev = 0;
 267
 268                     if (MyPlayer->Next != 0)
 269                     {
 270                         MyPlayer->Next->Prev = MyPlayer;
 271                     }
 272                 }
 273             }
 274             else
 275             {
 276                 if (d<0)
 277                 {
 278                     printf("Side %d\n",x);
 279
 280                     d=0.01;
 281                 }
 282                 if (d<MyPlayer->Size) /* Do we hit anything ? */
 283                 {
 284                     d=MyPlayer->Size-d;
 285
 286                     VctMulFix(&MyPlayer->Cube->Sides[x].Normal,d,&a);
 287                     VctAdd(&MyPlayer->Speed,&a,&MyPlayer->Speed);
 288                 }
 289             }
 290         }
 291     }
 292
 293     return Death;
 294 }
 295
 296 void MoveSpeed(pBot MyPlayer)
 297 {
 298     /*
 299     printf("Bot %ld %f,%f,%f\n",MyPlayer,MyPlayer->Pos.x,MyPlayer->Pos.y,MyPlayer->Pos.z);
 300     printf("    %ld %f,%f,%f\n",MyPlayer->Type,MyPlayer->Speed.x,MyPlayer->Speed.y,MyPlayer->Speed.z);
 301     */
 302     VctAdd(&MyPlayer->Pos,&MyPlayer->Speed,&MyPlayer->Pos);
 303     VctMulFix(&MyPlayer->Speed,SpeedDown,&MyPlayer->Speed);
 304 }
 305
 306 void MoveBot(pBot MyPlayer,pBot MyBot)
 307 {
 308     Vct a;
 309     /*
 310     printf("Bot %ld\n",MyBot);
 311     */
 312
 313     if ((MyBot->Type & BotMove) != 0)
 314     {
 315         VctSub(&MyPlayer->Pos,&MyBot->Pos,&a);
 316
 317         VctMulFix(&a,0.25/MyBot->Size/VctLength(&a),&a);
 318
 319         VctAdd(&a,&MyBot->Speed,&MyBot->Speed);
 320     }
 321
 322     if (!CheckCollision(MyBot))
 323     {
 324         MoveSpeed(MyBot);
 325     }
 326 }
 327
 328 void MoveBots(void)
 329 {
 330     pBot MyBot,NextBot,MyPlayer;
 331
 332     if (!Pause)
 333     {
 334         MyPlayer=&MyLevelData.Bots[0];
 335         /*
 336         printf("\nPlayer %ld\n",MyPlayer);
 337         printf("Bot %ld\n",MyPlayer->AbsNext);
 338         */
 339         MyBot=MyPlayer->AbsNext;
 340
 341         while (MyBot != NULL)
 342         {
 343             NextBot = MyBot->AbsNext;
 344
 345             MoveBot(MyPlayer,MyBot);
 346
 347             MyBot = NextBot;
 348         }
 349     }
 350 }
 351
 352 void MovePlayer(pBot MyPlayer)
 353 {
 354     struct IntuiMessage * MyMsg;
 355
 356     ZMove = 0;
 357
 358     while ((MyMsg=(struct IntuiMessage *)GetMsg(WindowPort)) != NULL)
 359     {
 360         switch (MyMsg->Class)
 361         {
 362             case IDCMP_VANILLAKEY:
 363             {
 364                 switch(MyMsg->Code)
 365                 {
 366                     case 27: /* ESC quit */
 367                     {
 368                         printf("\n Sucide is illegal here!\n");
 369                         Finished = (0==0);
 370                         break;
 371                     }
 372                     case 32: /* SPACE hit */
 373                     {
 374                         printf("KILL .. KILL .. KILL .. KILL .. KILL\n");
 375                         break;
 376                     }
 377                     case '7': /* turn anti-clockwise */
 378                     {
 379                         ZMove = -1;
 380                         break;
 381                     }
 382                     case '9': /* turn clockwise */
 383                     {
 384                         ZMove = 1;
 385                         break;
 386                     }
 387                     case 'l': /* decrease Light */
 388                     {
 389                         LightLess-=0.001;
 390
 391                         if (LightLess<0)
 392                             LightLess = 0.0;
 393
 394                         printf("Lightless: %f\n",LightLess);
 395
 396                         break;
 397                     }
 398                     case 'L': /* increase Light */
 399                     {
 400                         LightLess+=0.001;
 401
 402                         if (LightLess > 1.0)
 403                             LightLess = 1.0;
 404
 405                         printf("Lightless: %f\n",LightLess);
 406
 407                         break;
 408                     }
 409                     case '+': /* Decrease CameraBehind */
 410                     {
 411                         CameraBehind-=0.1;
 412
 413                         printf("CameraBehind: %f\n",CameraBehind);
 414
 415                         break;
 416                     }
 417                     case '-': /* Increase CameraBehind */
 418                     {
 419                         CameraBehind+=0.1;
 420
 421                         printf("CameraBehind: %f\n",CameraBehind);
 422
 423                         break;
 424                     }
 425                     case 'p': /* Pause */
 426                     {
 427                         Pause = !Pause;
 428                     }
 429                 }
 430                 break;
 431             }
 432             case IDCMP_RAWKEY:
 433             {
 434                 printf("Do you realy wanna harm that cute little cube?\n");
 435                 break;
 436             }
 437             case IDCMP_MOUSEBUTTONS:
 438             {
 439                 switch(MyMsg->Code)
 440                 {
 441                     case 104:
 442                     {
 443                         Button1 = (0==0);
 444                         break;
 445                     }
 446                     case 232:
 447                     {
 448                         Button1 = !(0==0);
 449                         break;
 450                     }
 451                     case 105:
 452                     {
 453                         Button2 = (0==0);
 454                         break;
 455                     }
 456                     case 233:
 457                     {
 458                         Button2 = !(0==0);
 459                         break;
 460                     }
 461                 }
 462             }
 463
 464             case IDCMP_MOUSEMOVE:
 465             {
 466                 MouseX=MyMsg->MouseX;
 467                 MouseY=MyMsg->MouseY;
 468             }
 469         }
 470
 471         ReplyMsg((struct Message *)MyMsg);
 472     }
 473
 474     if (MouseX<QuaterWidth)
 475     {
 476         XMove=+1;
 477     }
 478     else if (MouseX<HalfWidth+QuaterWidth)
 479     {
 480         XMove=0;
 481     }
 482     else
 483     {
 484         XMove=-1;
 485     }
 486
 487     if (MouseY<QuaterHeight)
 488     {
 489         YMove=-1;
 490     }
 491     else if (MouseY<HalfHeight+QuaterHeight)
 492     {
 493         YMove=0;
 494     }
 495     else
 496     {
 497         YMove=1;
 498     }
 499
 500     if (!Pause)
 501     {
 502         TurnPlayer(MyPlayer);
 503
 504         if (Button1)
 505         {
 506             MoveForward(MyPlayer);
 507         }
 508         if (Button2)
 509         {
 510             MoveBackward(MyPlayer);
 511         }
 512
 513         if (!CheckCollision(MyPlayer))
 514         {
 515             MoveSpeed(MyPlayer);
 516         }
 517         else
 518         {
 519             /* RIP */
 520         }
 521     }
 522 }
 523