Home » Archimedes archive » Archimedes World » archimedes_world_volume_15_issue_4_scp.adf » AcornAns » Flocking/c/main
Flocking/c/main
This website contains an archive of files for the Acorn Electron, BBC Micro, Acorn Archimedes, Commodore 16 and Commodore 64 computers, which Dominic Ford has rescued from his private collection of floppy disks and cassettes.
Some of these files were originally commercial releases in the 1980s and 1990s, but they are now widely available online. I assume that copyright over them is no longer being asserted. If you own the copyright and would like files to be removed, please contact me.
| Tape/disk: | Home » Archimedes archive » Archimedes World » archimedes_world_volume_15_issue_4_scp.adf » AcornAns |
| Filename: | Flocking/c/main |
| Read OK: | ✔ |
| File size: | 3A0A bytes |
| Load address: | 0000 |
| Exec address: | 0000 |
File contents
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <time.h>
#include <math.h>
#include <stdarg.h>
#include "werr.h"
#include "os.h"
#include "kernel.h"
#include "akbd.h"
#include "bbc.h"
#include "pointer.h"
#include "visdelay.h"
#include "swis.h"
#define lone 16
#define one (1<<lone)
#define fptod(i) ( (int)(0.5+i/6.5536)/10000.0 )
#define dtofp(i) ( (int)(0.5+i*one) )
#define abs(a) ((a)<0 ? -(a) : (a))
typedef enum {multi, nonmulti} monitor;
#define werrterm 0
/*principal quantities unbracketed, derived quantities bracketed:*/
typedef struct {
int x, y, r, r2; /*position, radius (& radius squared)*/
} pillar_data;
typedef struct bds {
int x, y, xn, yn; /*position (& new position)*/
int vx, vy, mv; /*velocity (& speed)*/
int dm, im; /*distance squared to nearest boid & index of that boid*/
int ax, ay, avx, avy, ac; /*accumulated relative-positions/velocities of boids in locale & number of such*/
struct bds *previous, *next; /*for doubly linked list representation*/
} boid_data;
typedef struct node {
struct node *next;
} gnode;
extern int rbbcinc(int r, int k);
extern int div_frac16(int number, int divisor);
extern int mul_frac16(int x, int a);
extern int mul_frac16c(int x, int a);
extern int sqrt_frac16(unsigned int x);
extern int gauss16(void);
extern void sgauss16(int seed);
extern int rand16(void);
extern int randu16(void);
extern void srand16(int seed);
extern int cos16(int a);
extern int sin16(int a);
extern int exp16(int a);
extern int ln16(int a);
extern int pow16(int a, int b);
extern int acs16(int a);
extern int asn16(int a);
extern int sig16(int a);
extern int square1610(int x);
/*multiplies two 16 bit fixed point numbers, returning a 10 bit fixed point number, hence can represent
numbers upto 1448*1448 eg result of mul1610(1448*one,1448*one);
useful for arithmetic with squares of positions or velocities*/
#define mul1610(a,b) (mul_frac16((a)/8,(b)/8))
/*returns 16 bfp square root of 10 bfp argument*/
#define sqrt1016(a) (8*sqrt_frac16((a)))
BOOL vga;
int mode;
int bank;
BOOL single_step;
int tn2, ttotal;
int n, g;
int rc, rm, rl, rc2, rl2;
int pn, mc;
pillar_data *pillar=0;
boid_data *boid=0, *h;
boid_data zlow, zhigh;
gnode **grid=0;
gnode *boidgnode=0;
int maxgx, maxgy, gsize, lgsize, grl;
BOOL *gmask=0;
#define xtogi(v) ( (640*one+(v)) >> (lone+lgsize) )
#define ytogi(v) ( (512*one+(v)) >> (lone+lgsize) )
monitor read_monitor_type(void)
{
int r2;
os_swi3r(6, 161,133,0, 0,0,&r2);
if ((r2/4 & 3) == 1) return multi;
else return nonmulti;
}
void tidy(void)
{
os_swi2(OS_Byte, 112, 1);
os_swi2(OS_Byte, 113, 1);
}
void swap_banks(void)
{
os_swi2(OS_Byte, 113, bank);
os_swi2(OS_Byte, 112, bank=3-bank);
}
void prepare_screen(void)
{
bank=1;
os_swi2(OS_Byte, 112, bank);
os_swi2(OS_Byte, 113, 3-bank);
}
void press(int i)
{
for (;bbc_inkey(i)!=-1;);
return;
}
void release(int i)
{
for (;bbc_inkey(i)!=0;);
return;
}
BOOL kbhit(void)
{
return bbc_inkey(-99)==-1;
}
void step(void)
{
if (bbc_inkey(-82)) single_step=TRUE;
if (single_step) for (; single_step;) {
if (bbc_inkey(-82)) {
release(-82);
break;
}
if (bbc_inkey(-83)) single_step=FALSE;
}
}
void seed_rand16(void)
{
int v=clock() & 0xff;
v|=v<<8;
srand16(v | v<<16);
}
/*returns 16bfp magnitude of vector with 16bfp components x & y*/
int magnitude(int x, int y)
{
int f = sqrt1016(mul1610(x,x)+mul1610(y,y));
if (f<abs(x)) f=abs(x); /*compensate for some nasty underflow problems*/
if (f<abs(y)) f=abs(y); /*with above fixed point arithmetic*/
return f<one/256 ? one/256 : f;
}
int nearests_sqrt(int i)
{
int f = sqrt1016(boid[i].dm);
if (f<abs(boid[boid[i].im].x-boid[i].x)) f=abs(boid[boid[i].im].x-boid[i].x);
if (f<abs(boid[boid[i].im].y-boid[i].y)) f=abs(boid[boid[i].im].y-boid[i].y);
return f<one/256 ? one/256 : f;
}
/*'bounce' velocity via approach vector, nb x,y,vx,vy 16bfp, while m=x*x+y*y 10bfp*/
void bounce(int x, int y, int *vx, int *vy, int m)
{
int s = mul1610(x, *vx) + mul1610(y, *vy);
if (s>0) {
s = 2*div_frac16(s, m==0 ? 1 : m);
*vx -= mul_frac16(x, s);
*vy -= mul_frac16(y, s);
}
}
BOOL init(void)
{
int i, j;
atexit(tidy);
vga = read_monitor_type()==multi ? TRUE : FALSE;
mode = vga ? 18 : 0;
tidy();
bbc_mode(mode+128);
bbc_mode(mode);
bbc_cursor(0);
os_cli("pointer");
bbc_origin(640,512);
pointer_reset_shape();
release(-99);
os_swi2(OS_Byte, 15, 1);
do {
printf("Please enter number of boids (min 2, suggest 24+) ");
scanf("%i", &n);
} while (n<2);
do {
printf("Please enter number of pillars (1 to 100, suggest 4) ");
scanf("%i", &pn);
} while (pn<1 || pn>100);
do {
printf("Please enter boid size (1 to 8, suggest 4) ");
scanf("%i", &g);
} while (g<1 || g>8);
do {
printf("Please enter seed for random initialisation (any non-zero integer,\nor 0 for a 'random' seed; try 101) ");
scanf("%i", &i);
} while (FALSE);
if (i) srand16(~(i^(i<<16)));
else seed_rand16();
rc=5*g*one; /*radius for collision detection*/
rm=8*g*one; /*radius for velocity matching*/
rl=20*g*one; /*radius of locale*/
rc2=mul1610(rc,rc);
rl2=mul1610(rl,rl);
if (pillar) {
free(pillar);
pillar=0;
}
if (boid) {
free(boid);
boid=0;
}
if (grid) {
free(grid);
grid=0;
}
if (boidgnode) {
free(boidgnode);
boidgnode=0;
}
if (gmask) {
free(gmask);
gmask=0;
}
if (pillar = calloc(pn, sizeof(pillar_data)), pillar==0) {
werr(werrterm, "Insufficient memory");
return FALSE;
}
if (boid = calloc( n, sizeof( boid_data)), boid==0) {
werr(werrterm, "Insufficient memory");
return FALSE;
}
gsize = rc;
lgsize= (int)(log(fptod(gsize))/0.69315 + 1.0);
gsize = 1<<lgsize; /*round it up to a power of 2*/
grl = (rl/one)/gsize + 1;
maxgx = 1+1280/gsize;
maxgy = 1+1024/gsize;
if (gmask = calloc((grl+1)*(grl+1), sizeof(BOOL)), gmask==0) {
werr(werrterm, "Insufficient memory");
return FALSE;
}
for (j=0; j<=grl; j++)
for (i=0; i<=grl; i++)
gmask[i+(grl+1)*j] = ( i>0 && j>0 && ((i-1)*(i-1)+(j-1)*(j-1))*gsize*gsize>(rl/one)*(rl/one) ) ? FALSE : TRUE;
if (grid = calloc((maxgx+1)*(maxgy+1), sizeof(gnode *)), grid==0) {
werr(werrterm, "Insufficient memory");
return FALSE;
}
if (boidgnode = calloc( n, sizeof(gnode)), boidgnode==0) {
werr(werrterm, "Insufficient memory");
return FALSE;
}
mc=0;
for (i=0; i<pn; i++) {
pillar[i].x = rand16()*640;
pillar[i].y = rand16()*512;
pillar[i].r = randu16()*40;
pillar[i].r2 = mul1610(pillar[i].r+rc/2, pillar[i].r+rc/2);
}
for (i=0; i<n; i++) {
boid[i].x = 64*g*rand16();
boid[i].y = 64*g*rand16();
boid[i].vx = 4*g*randu16();
boid[i].vy = 2*g*rand16();
boid[i].mv = magnitude(boid[i].vx,boid[i].vy);
boid[i].previous = boid+i-1; /*since initially boids are linked in memory order*/
boid[i].next = boid+i+1;
}
h = boid;
boid[0].previous = &zlow;
boid[n-1].next = &zhigh;
zlow.previous = zlow.next = &zlow;
zhigh.previous = zhigh.next = &zhigh;
zlow.x = zlow.y = -640*one; /*smallest number*/
zhigh.x = zhigh.y = 640*one; /*biggest number*/
prepare_screen();
return TRUE;
}
void check_mouse(void)
{
int x,y,z, i,d;
os_swi3r(OS_Mouse, 0,0,0, &x,&y,&z);
x*=one;
y*=one;
switch(z) {
case 1:
if (pillar[mc].r>one) {
pillar[mc].r-=one;
pillar[mc].r2=mul1610(pillar[mc].r+rc/2, pillar[mc].r+rc/2);
}
break;
case 2:
if (pillar[mc].r<one*200) {
pillar[mc].r+=one;
pillar[mc].r2=mul1610(pillar[mc].r+rc/2, pillar[mc].r+rc/2);
}
break;
case 4:
for (i=mc; i<pn; i++) {
if (abs(pillar[i].x-x)<pillar[i].r && abs(pillar[i].y-y)<pillar[i].r) {
d = mul1610(pillar[i].x-x,pillar[i].x-x) + mul1610(pillar[i].y-y,pillar[i].y-y);
if (d < pillar[i].r2) {
i+=0x10000;
break;
}
}
if (i==mc) i=-1;
if (i==mc-1) i=mc;
}
if (i&0x10000 && i!=0x10000+mc) {
mc = i-0x10000;
bbc_vdu(7);
}
else {
pillar[mc].x = x;
pillar[mc].y = y;
}
break;
}
}
boid_data *merge(boid_data *a, boid_data *b, int offset)
{
boid_data *c;
c = &zlow;
do {
if ( *((int *)a+offset) < *((int *)b+offset) ) {
c->next = a;
a->previous = c;
c = a;
a = a->next;
}
else {
c->next = b;
b->previous = c;
c = b;
b = b->next;
}
} while (c != &zhigh);
c = zlow.next;
zlow.next = &zlow;
zhigh.previous = &zhigh;
return c;
}
boid_data *sort_y_ncalcclosest(boid_data *c, int n)
{
int middle;
boid_data *a, *b;
static int i, d;
static BOOL left;
if (c->next==&zhigh) return c;
a = c;
for (i=2; i<=n/2; i++) c=c->next;
b = c->next;
c->next = &zhigh;
b->previous = &zlow;
middle = b->x;
c = merge(sort_y_ncalcclosest(a, n/2), sort_y_ncalcclosest(b, n-n/2), &a->y - (int *)a);
for (a=c; a!=&zhigh; a=a->next) {
if (square1610(a->x-middle) < a->dm) {
left = a->x<middle;
for (b=a->next; b!=&zhigh && (d=square1610(b->y-a->y))<a->dm; b=b->next) {
if (left && b->x>=middle || !left && b->x<=middle) {
d+=square1610(b->x-a->x);
if (d<a->dm) {
a->dm = d;
a->im = b-boid;
}
if (d<b->dm) {
b->dm = d;
b->im = a-boid;
}
}
}
for (b=a->previous; b!=&zlow && (d=square1610(b->y-a->y))<a->dm; b=b->previous) {
if (left && b->x>=middle || !left && b->x<=middle) {
d+=square1610(b->x-a->x);
if (d<a->dm) {
a->dm = d;
a->im = b-boid;
}
if (d<b->dm) {
b->dm = d;
b->im = a-boid;
}
}
}
}
}
return c;
}
boid_data *sort_x(boid_data *c, int n)
{
int i;
boid_data *a, *b;
if (c->next==&zhigh) return c;
a = c;
for (i=2; i<=n/2; i++) c=c->next;
b = c->next;
c->next = &zhigh;
b->previous = &zlow;
c = merge(sort_x(a, n/2), sort_x(b, n-n/2), &a->x - (int *)a);
return c;
}
void move_boids(void)
{
int i, j, d;
int x, y, vx, vy;
int a, b;
int k, l, p, q;
gnode *t;
boid_data *bp, *bpe;
for (bp=boid,bpe=bp+n; bp<bpe; bp++) {
bp->dm=0x7fffffff;
bp->ax=bp->ay=bp->avx=bp->avy=bp->ac=0;
}
tn2=clock();
/*range checking*/
memset(grid, 0, sizeof(gnode *)*(maxgx+1)*(maxgy+1));
for (i=0; i<n; i++) { /*first we insert all boids into grid*/
a = xtogi(boid[i].x);
if (a<0) a=0;
if (a>maxgx) a=maxgx;
b = ytogi(boid[i].y);
if (b<0) b=0;
if (b>maxgy) b=maxgy;
j = a+(maxgx+1)*b;
boidgnode[i].next = grid[j];
grid[j] = boidgnode+i;
}
for (i=0; i<n; i++) { /*then we range check via the grid*/
a = xtogi(boid[i].x);
if (a<0) a=0;
if (a>maxgx) a=maxgx;
b = ytogi(boid[i].y);
if (b<0) b=0;
if (b>maxgy) b=maxgy;
k = a-grl<0 ? 0 : a-grl;
l = b-grl<0 ? 0 : b-grl;
p = a+grl>maxgx ? maxgx : a+grl;
q = b+grl>maxgy ? maxgy : b+grl;
for (y=l; y<=q; y++)
for (x=k; x<=p; x++)
if (gmask[abs(x-a)+(grl+1)*abs(y-b)]) {
for (t=grid[x+(maxgx+1)*y]; t!=0; t=t->next) {
j = t-boidgnode;
if (i<j) {
d = square1610(boid[i].x-boid[j].x) + square1610(boid[i].y-boid[j].y);
if (d<rl2) {
boid[i].ax += boid[j].x-boid[i].x;
boid[i].ay += boid[j].y-boid[i].y;
boid[i].avx += boid[j].vx;
boid[i].avy += boid[j].vy;
boid[i].ac += 1;
boid[j].ax += boid[i].x-boid[j].x;
boid[j].ay += boid[i].y-boid[j].y;
boid[j].avx += boid[i].vx;
boid[j].avy += boid[i].vy;
boid[j].ac += 1;
}
}
}
}
}
/*minimum distance calculation*/
h = sort_x(h, n);
h = sort_y_ncalcclosest(h, n);
/*range checking & minimum distance calculations complete*/
tn2=clock()-tn2;
for (i=0; i<n; i++) {
x = boid[i].x;
y = boid[i].y;
vx = boid[i].vx;
vy = boid[i].vy;
if (boid[i].ac<1) {
j = boid[i].im;
boid[i].ax += boid[j].x-x;
boid[i].ay += boid[j].y-y;
boid[i].avx += boid[j].vx;
boid[i].avy += boid[j].vy;
boid[i].ac += 1;
}
if (x<rc-640*one || x>640*one-rc || y<rc-512*one || y>512*one-rc) {
if (x<rc-640*one&&vx<0 || x>640*one-rc&&vx>0) vx=-vx;
if (y<rc-512*one&&vy<0 || y>512*one-rc&&vy>0) vy=-vy;
}
else {
for (j=0; j<pn; j++) {
if (abs(pillar[j].x-x)<pillar[j].r && abs(pillar[j].y-y)<pillar[j].r) {
d = mul1610(pillar[j].x-x,pillar[j].x-x) + mul1610(pillar[j].y-y,pillar[j].y-y);
if (d < pillar[j].r2) {
j+=0x10000;
break;
}
}
}
if (j & 0x10000) {
j-=0x10000;
bounce(pillar[j].x-x, pillar[j].y-y, &vx, &vy, d);
}
else if (boid[i].dm<rc2) bounce(boid[boid[i].im].x-x, boid[boid[i].im].y-y, &vx, &vy, boid[i].dm);
else {
a = boid[i].ax/boid[i].ac;
b = boid[i].ay/boid[i].ac;
d = magnitude(a,b);
a = div_frac16(a,d);
b = div_frac16(b,d);
d = nearests_sqrt(i);
if (d<rm) {
vx = div_frac16( mul_frac16(boid[i].avx/boid[i].ac, rm-d)+mul_frac16(d-rc, a*g) , rm-rc );
vy = div_frac16( mul_frac16(boid[i].avy/boid[i].ac, rm-d)+mul_frac16(d-rc, b*g) , rm-rc );
}
else {
d = div_frac16(d, rm);
if (d>16*one) d=16*one; /*prevent ridiculously high catch up speeds*/
vx = mul_frac16(d, a*g);
vy = mul_frac16(d, b*g);
}
}
}
d = magnitude(vx,vy);
if (d<g*one) {
vx = div_frac16(vx*g,d);
vy = div_frac16(vy*g,d);
d = g*one;
}
boid[i].xn = boid[i].x+vx;
boid[i].yn = boid[i].y+vy;
boid[i].vx = vx;
boid[i].vy = vy;
boid[i].mv = d;
}
for (i=0; i<n; i++) {
boid[i].x = boid[i].xn;
boid[i].y = boid[i].yn;
}
}
int main(void)
{
int i;
if (!init()) return 0;
for (single_step=FALSE;;) {
ttotal=clock();
bbc_cls();
move_boids();
check_mouse();
for (i=0; i<n; i++) {
bbc_move(boid[i].x/one, boid[i].y/one);
bbc_drawby((boid[i].vx*2*g)/boid[i].mv, (boid[i].vy*2*g)/boid[i].mv);
}
for (i=0; i<pn; i++) bbc_circle(pillar[i].x/one, pillar[i].y/one, pillar[i].r/one);
ttotal=clock()-ttotal;
printf("%i\n%i\n",tn2,ttotal);
os_swi1(OS_Byte, 19);
swap_banks();
step();
if (kbhit())
if (!init()) break;
}
return 0;
}
00000000 0a 23 69 6e 63 6c 75 64 65 20 3c 73 74 64 69 6f |.#include <stdio|
00000010 2e 68 3e 0a 23 69 6e 63 6c 75 64 65 20 3c 73 74 |.h>.#include <st|
00000020 64 6c 69 62 2e 68 3e 0a 23 69 6e 63 6c 75 64 65 |dlib.h>.#include|
00000030 20 3c 73 74 72 69 6e 67 2e 68 3e 0a 23 69 6e 63 | <string.h>.#inc|
00000040 6c 75 64 65 20 3c 74 69 6d 65 2e 68 3e 0a 23 69 |lude <time.h>.#i|
00000050 6e 63 6c 75 64 65 20 3c 6d 61 74 68 2e 68 3e 0a |nclude <math.h>.|
00000060 23 69 6e 63 6c 75 64 65 20 3c 73 74 64 61 72 67 |#include <stdarg|
00000070 2e 68 3e 0a 0a 23 69 6e 63 6c 75 64 65 20 22 77 |.h>..#include "w|
00000080 65 72 72 2e 68 22 0a 23 69 6e 63 6c 75 64 65 20 |err.h".#include |
00000090 22 6f 73 2e 68 22 0a 23 69 6e 63 6c 75 64 65 20 |"os.h".#include |
000000a0 22 6b 65 72 6e 65 6c 2e 68 22 0a 23 69 6e 63 6c |"kernel.h".#incl|
000000b0 75 64 65 20 22 61 6b 62 64 2e 68 22 0a 23 69 6e |ude "akbd.h".#in|
000000c0 63 6c 75 64 65 20 22 62 62 63 2e 68 22 0a 23 69 |clude "bbc.h".#i|
000000d0 6e 63 6c 75 64 65 20 22 70 6f 69 6e 74 65 72 2e |nclude "pointer.|
000000e0 68 22 0a 23 69 6e 63 6c 75 64 65 20 22 76 69 73 |h".#include "vis|
000000f0 64 65 6c 61 79 2e 68 22 0a 0a 23 69 6e 63 6c 75 |delay.h"..#inclu|
00000100 64 65 20 22 73 77 69 73 2e 68 22 0a 0a 23 64 65 |de "swis.h"..#de|
00000110 66 69 6e 65 20 6c 6f 6e 65 20 31 36 0a 23 64 65 |fine lone 16.#de|
00000120 66 69 6e 65 20 6f 6e 65 20 28 31 3c 3c 6c 6f 6e |fine one (1<<lon|
00000130 65 29 0a 23 64 65 66 69 6e 65 20 66 70 74 6f 64 |e).#define fptod|
00000140 28 69 29 20 28 20 28 69 6e 74 29 28 30 2e 35 2b |(i) ( (int)(0.5+|
00000150 69 2f 36 2e 35 35 33 36 29 2f 31 30 30 30 30 2e |i/6.5536)/10000.|
00000160 30 20 29 0a 23 64 65 66 69 6e 65 20 64 74 6f 66 |0 ).#define dtof|
00000170 70 28 69 29 20 28 20 28 69 6e 74 29 28 30 2e 35 |p(i) ( (int)(0.5|
00000180 2b 69 2a 6f 6e 65 29 20 29 0a 23 64 65 66 69 6e |+i*one) ).#defin|
00000190 65 20 61 62 73 28 61 29 20 28 28 61 29 3c 30 20 |e abs(a) ((a)<0 |
000001a0 3f 20 2d 28 61 29 20 3a 20 28 61 29 29 0a 74 79 |? -(a) : (a)).ty|
000001b0 70 65 64 65 66 20 65 6e 75 6d 20 7b 6d 75 6c 74 |pedef enum {mult|
000001c0 69 2c 20 6e 6f 6e 6d 75 6c 74 69 7d 20 6d 6f 6e |i, nonmulti} mon|
000001d0 69 74 6f 72 3b 0a 0a 23 64 65 66 69 6e 65 20 77 |itor;..#define w|
000001e0 65 72 72 74 65 72 6d 20 30 0a 09 09 09 09 2f 2a |errterm 0...../*|
000001f0 70 72 69 6e 63 69 70 61 6c 20 71 75 61 6e 74 69 |principal quanti|
00000200 74 69 65 73 20 75 6e 62 72 61 63 6b 65 74 65 64 |ties unbracketed|
00000210 2c 20 64 65 72 69 76 65 64 20 71 75 61 6e 74 69 |, derived quanti|
00000220 74 69 65 73 20 62 72 61 63 6b 65 74 65 64 3a 2a |ties bracketed:*|
00000230 2f 0a 74 79 70 65 64 65 66 20 73 74 72 75 63 74 |/.typedef struct|
00000240 20 7b 0a 20 20 69 6e 74 20 78 2c 20 79 2c 20 72 | {. int x, y, r|
00000250 2c 20 72 32 3b 09 09 2f 2a 70 6f 73 69 74 69 6f |, r2;../*positio|
00000260 6e 2c 20 72 61 64 69 75 73 20 28 26 20 72 61 64 |n, radius (& rad|
00000270 69 75 73 20 73 71 75 61 72 65 64 29 2a 2f 0a 7d |ius squared)*/.}|
00000280 20 70 69 6c 6c 61 72 5f 64 61 74 61 3b 0a 0a 74 | pillar_data;..t|
00000290 79 70 65 64 65 66 20 73 74 72 75 63 74 20 62 64 |ypedef struct bd|
000002a0 73 20 7b 0a 20 20 69 6e 74 20 78 2c 20 79 2c 20 |s {. int x, y, |
000002b0 78 6e 2c 20 79 6e 3b 09 09 2f 2a 70 6f 73 69 74 |xn, yn;../*posit|
000002c0 69 6f 6e 20 28 26 20 6e 65 77 20 70 6f 73 69 74 |ion (& new posit|
000002d0 69 6f 6e 29 2a 2f 0a 20 20 69 6e 74 20 76 78 2c |ion)*/. int vx,|
000002e0 20 76 79 2c 20 6d 76 3b 09 09 2f 2a 76 65 6c 6f | vy, mv;../*velo|
000002f0 63 69 74 79 20 28 26 20 73 70 65 65 64 29 2a 2f |city (& speed)*/|
00000300 0a 20 20 69 6e 74 20 64 6d 2c 20 69 6d 3b 09 09 |. int dm, im;..|
00000310 09 2f 2a 64 69 73 74 61 6e 63 65 20 73 71 75 61 |./*distance squa|
00000320 72 65 64 20 74 6f 20 6e 65 61 72 65 73 74 20 62 |red to nearest b|
00000330 6f 69 64 20 26 20 69 6e 64 65 78 20 6f 66 20 74 |oid & index of t|
00000340 68 61 74 20 62 6f 69 64 2a 2f 0a 20 20 69 6e 74 |hat boid*/. int|
00000350 20 61 78 2c 20 61 79 2c 20 61 76 78 2c 20 61 76 | ax, ay, avx, av|
00000360 79 2c 20 61 63 3b 09 2f 2a 61 63 63 75 6d 75 6c |y, ac;./*accumul|
00000370 61 74 65 64 20 72 65 6c 61 74 69 76 65 2d 70 6f |ated relative-po|
00000380 73 69 74 69 6f 6e 73 2f 76 65 6c 6f 63 69 74 69 |sitions/velociti|
00000390 65 73 20 6f 66 20 62 6f 69 64 73 20 69 6e 20 6c |es of boids in l|
000003a0 6f 63 61 6c 65 20 26 20 6e 75 6d 62 65 72 20 6f |ocale & number o|
000003b0 66 20 73 75 63 68 2a 2f 0a 20 20 73 74 72 75 63 |f such*/. struc|
000003c0 74 20 62 64 73 20 2a 70 72 65 76 69 6f 75 73 2c |t bds *previous,|
000003d0 20 2a 6e 65 78 74 3b 09 2f 2a 66 6f 72 20 64 6f | *next;./*for do|
000003e0 75 62 6c 79 20 6c 69 6e 6b 65 64 20 6c 69 73 74 |ubly linked list|
000003f0 20 72 65 70 72 65 73 65 6e 74 61 74 69 6f 6e 2a | representation*|
00000400 2f 0a 7d 20 62 6f 69 64 5f 64 61 74 61 3b 0a 0a |/.} boid_data;..|
00000410 74 79 70 65 64 65 66 20 73 74 72 75 63 74 20 6e |typedef struct n|
00000420 6f 64 65 20 7b 0a 20 20 73 74 72 75 63 74 20 6e |ode {. struct n|
00000430 6f 64 65 20 2a 6e 65 78 74 3b 0a 7d 20 67 6e 6f |ode *next;.} gno|
00000440 64 65 3b 0a 0a 65 78 74 65 72 6e 20 69 6e 74 20 |de;..extern int |
00000450 72 62 62 63 69 6e 63 28 69 6e 74 20 72 2c 20 69 |rbbcinc(int r, i|
00000460 6e 74 20 6b 29 3b 0a 65 78 74 65 72 6e 20 69 6e |nt k);.extern in|
00000470 74 20 64 69 76 5f 66 72 61 63 31 36 28 69 6e 74 |t div_frac16(int|
00000480 20 6e 75 6d 62 65 72 2c 20 69 6e 74 20 64 69 76 | number, int div|
00000490 69 73 6f 72 29 3b 0a 65 78 74 65 72 6e 20 69 6e |isor);.extern in|
000004a0 74 20 6d 75 6c 5f 66 72 61 63 31 36 28 69 6e 74 |t mul_frac16(int|
000004b0 20 78 2c 20 69 6e 74 20 61 29 3b 0a 65 78 74 65 | x, int a);.exte|
000004c0 72 6e 20 69 6e 74 20 6d 75 6c 5f 66 72 61 63 31 |rn int mul_frac1|
000004d0 36 63 28 69 6e 74 20 78 2c 20 69 6e 74 20 61 29 |6c(int x, int a)|
000004e0 3b 0a 65 78 74 65 72 6e 20 69 6e 74 20 73 71 72 |;.extern int sqr|
000004f0 74 5f 66 72 61 63 31 36 28 75 6e 73 69 67 6e 65 |t_frac16(unsigne|
00000500 64 20 69 6e 74 20 78 29 3b 0a 65 78 74 65 72 6e |d int x);.extern|
00000510 20 69 6e 74 20 67 61 75 73 73 31 36 28 76 6f 69 | int gauss16(voi|
00000520 64 29 3b 0a 65 78 74 65 72 6e 20 76 6f 69 64 20 |d);.extern void |
00000530 73 67 61 75 73 73 31 36 28 69 6e 74 20 73 65 65 |sgauss16(int see|
00000540 64 29 3b 0a 65 78 74 65 72 6e 20 69 6e 74 20 72 |d);.extern int r|
00000550 61 6e 64 31 36 28 76 6f 69 64 29 3b 0a 65 78 74 |and16(void);.ext|
00000560 65 72 6e 20 69 6e 74 20 72 61 6e 64 75 31 36 28 |ern int randu16(|
00000570 76 6f 69 64 29 3b 0a 65 78 74 65 72 6e 20 76 6f |void);.extern vo|
00000580 69 64 20 73 72 61 6e 64 31 36 28 69 6e 74 20 73 |id srand16(int s|
00000590 65 65 64 29 3b 0a 65 78 74 65 72 6e 20 69 6e 74 |eed);.extern int|
000005a0 20 63 6f 73 31 36 28 69 6e 74 20 61 29 3b 0a 65 | cos16(int a);.e|
000005b0 78 74 65 72 6e 20 69 6e 74 20 73 69 6e 31 36 28 |xtern int sin16(|
000005c0 69 6e 74 20 61 29 3b 0a 65 78 74 65 72 6e 20 69 |int a);.extern i|
000005d0 6e 74 20 65 78 70 31 36 28 69 6e 74 20 61 29 3b |nt exp16(int a);|
000005e0 0a 65 78 74 65 72 6e 20 69 6e 74 20 6c 6e 31 36 |.extern int ln16|
000005f0 28 69 6e 74 20 61 29 3b 0a 65 78 74 65 72 6e 20 |(int a);.extern |
00000600 69 6e 74 20 70 6f 77 31 36 28 69 6e 74 20 61 2c |int pow16(int a,|
00000610 20 69 6e 74 20 62 29 3b 0a 65 78 74 65 72 6e 20 | int b);.extern |
00000620 69 6e 74 20 61 63 73 31 36 28 69 6e 74 20 61 29 |int acs16(int a)|
00000630 3b 0a 65 78 74 65 72 6e 20 69 6e 74 20 61 73 6e |;.extern int asn|
00000640 31 36 28 69 6e 74 20 61 29 3b 0a 65 78 74 65 72 |16(int a);.exter|
00000650 6e 20 69 6e 74 20 73 69 67 31 36 28 69 6e 74 20 |n int sig16(int |
00000660 61 29 3b 0a 65 78 74 65 72 6e 20 69 6e 74 20 73 |a);.extern int s|
00000670 71 75 61 72 65 31 36 31 30 28 69 6e 74 20 78 29 |quare1610(int x)|
00000680 3b 0a 0a 2f 2a 6d 75 6c 74 69 70 6c 69 65 73 20 |;../*multiplies |
00000690 74 77 6f 20 31 36 20 62 69 74 20 66 69 78 65 64 |two 16 bit fixed|
000006a0 20 70 6f 69 6e 74 20 6e 75 6d 62 65 72 73 2c 20 | point numbers, |
000006b0 72 65 74 75 72 6e 69 6e 67 20 61 20 31 30 20 62 |returning a 10 b|
000006c0 69 74 20 66 69 78 65 64 20 70 6f 69 6e 74 20 6e |it fixed point n|
000006d0 75 6d 62 65 72 2c 20 68 65 6e 63 65 20 63 61 6e |umber, hence can|
000006e0 20 72 65 70 72 65 73 65 6e 74 0a 20 20 6e 75 6d | represent. num|
000006f0 62 65 72 73 20 75 70 74 6f 20 31 34 34 38 2a 31 |bers upto 1448*1|
00000700 34 34 38 20 65 67 20 72 65 73 75 6c 74 20 6f 66 |448 eg result of|
00000710 20 6d 75 6c 31 36 31 30 28 31 34 34 38 2a 6f 6e | mul1610(1448*on|
00000720 65 2c 31 34 34 38 2a 6f 6e 65 29 3b 0a 20 20 75 |e,1448*one);. u|
00000730 73 65 66 75 6c 20 66 6f 72 20 61 72 69 74 68 6d |seful for arithm|
00000740 65 74 69 63 20 77 69 74 68 20 73 71 75 61 72 65 |etic with square|
00000750 73 20 6f 66 20 70 6f 73 69 74 69 6f 6e 73 20 6f |s of positions o|
00000760 72 20 76 65 6c 6f 63 69 74 69 65 73 2a 2f 0a 23 |r velocities*/.#|
00000770 64 65 66 69 6e 65 20 6d 75 6c 31 36 31 30 28 61 |define mul1610(a|
00000780 2c 62 29 20 28 6d 75 6c 5f 66 72 61 63 31 36 28 |,b) (mul_frac16(|
00000790 28 61 29 2f 38 2c 28 62 29 2f 38 29 29 0a 2f 2a |(a)/8,(b)/8))./*|
000007a0 72 65 74 75 72 6e 73 20 31 36 20 62 66 70 20 73 |returns 16 bfp s|
000007b0 71 75 61 72 65 20 72 6f 6f 74 20 6f 66 20 31 30 |quare root of 10|
000007c0 20 62 66 70 20 61 72 67 75 6d 65 6e 74 2a 2f 0a | bfp argument*/.|
000007d0 23 64 65 66 69 6e 65 20 73 71 72 74 31 30 31 36 |#define sqrt1016|
000007e0 28 61 29 20 28 38 2a 73 71 72 74 5f 66 72 61 63 |(a) (8*sqrt_frac|
000007f0 31 36 28 28 61 29 29 29 0a 0a 42 4f 4f 4c 20 76 |16((a)))..BOOL v|
00000800 67 61 3b 0a 69 6e 74 20 6d 6f 64 65 3b 0a 69 6e |ga;.int mode;.in|
00000810 74 20 62 61 6e 6b 3b 0a 42 4f 4f 4c 20 73 69 6e |t bank;.BOOL sin|
00000820 67 6c 65 5f 73 74 65 70 3b 0a 69 6e 74 20 74 6e |gle_step;.int tn|
00000830 32 2c 20 74 74 6f 74 61 6c 3b 0a 0a 69 6e 74 20 |2, ttotal;..int |
00000840 6e 2c 20 67 3b 0a 69 6e 74 20 72 63 2c 20 72 6d |n, g;.int rc, rm|
00000850 2c 20 72 6c 2c 20 72 63 32 2c 20 72 6c 32 3b 0a |, rl, rc2, rl2;.|
00000860 69 6e 74 20 70 6e 2c 20 6d 63 3b 0a 70 69 6c 6c |int pn, mc;.pill|
00000870 61 72 5f 64 61 74 61 20 2a 70 69 6c 6c 61 72 3d |ar_data *pillar=|
00000880 30 3b 0a 62 6f 69 64 5f 64 61 74 61 20 2a 62 6f |0;.boid_data *bo|
00000890 69 64 3d 30 2c 20 2a 68 3b 0a 62 6f 69 64 5f 64 |id=0, *h;.boid_d|
000008a0 61 74 61 20 7a 6c 6f 77 2c 20 7a 68 69 67 68 3b |ata zlow, zhigh;|
000008b0 0a 0a 67 6e 6f 64 65 20 2a 2a 67 72 69 64 3d 30 |..gnode **grid=0|
000008c0 3b 0a 67 6e 6f 64 65 20 2a 62 6f 69 64 67 6e 6f |;.gnode *boidgno|
000008d0 64 65 3d 30 3b 0a 69 6e 74 20 6d 61 78 67 78 2c |de=0;.int maxgx,|
000008e0 20 6d 61 78 67 79 2c 20 67 73 69 7a 65 2c 20 6c | maxgy, gsize, l|
000008f0 67 73 69 7a 65 2c 20 67 72 6c 3b 0a 42 4f 4f 4c |gsize, grl;.BOOL|
00000900 20 2a 67 6d 61 73 6b 3d 30 3b 0a 23 64 65 66 69 | *gmask=0;.#defi|
00000910 6e 65 20 78 74 6f 67 69 28 76 29 20 28 20 28 36 |ne xtogi(v) ( (6|
00000920 34 30 2a 6f 6e 65 2b 28 76 29 29 20 3e 3e 20 28 |40*one+(v)) >> (|
00000930 6c 6f 6e 65 2b 6c 67 73 69 7a 65 29 20 29 0a 23 |lone+lgsize) ).#|
00000940 64 65 66 69 6e 65 20 79 74 6f 67 69 28 76 29 20 |define ytogi(v) |
00000950 28 20 28 35 31 32 2a 6f 6e 65 2b 28 76 29 29 20 |( (512*one+(v)) |
00000960 3e 3e 20 28 6c 6f 6e 65 2b 6c 67 73 69 7a 65 29 |>> (lone+lgsize)|
00000970 20 29 0a 0a 6d 6f 6e 69 74 6f 72 20 72 65 61 64 | )..monitor read|
00000980 5f 6d 6f 6e 69 74 6f 72 5f 74 79 70 65 28 76 6f |_monitor_type(vo|
00000990 69 64 29 0a 7b 0a 20 20 69 6e 74 20 72 32 3b 0a |id).{. int r2;.|
000009a0 20 20 6f 73 5f 73 77 69 33 72 28 36 2c 20 31 36 | os_swi3r(6, 16|
000009b0 31 2c 31 33 33 2c 30 2c 20 30 2c 30 2c 26 72 32 |1,133,0, 0,0,&r2|
000009c0 29 3b 0a 20 20 69 66 20 28 28 72 32 2f 34 20 26 |);. if ((r2/4 &|
000009d0 20 33 29 20 3d 3d 20 31 29 20 72 65 74 75 72 6e | 3) == 1) return|
000009e0 20 6d 75 6c 74 69 3b 0a 20 20 65 6c 73 65 20 72 | multi;. else r|
000009f0 65 74 75 72 6e 20 6e 6f 6e 6d 75 6c 74 69 3b 0a |eturn nonmulti;.|
00000a00 7d 0a 0a 76 6f 69 64 20 74 69 64 79 28 76 6f 69 |}..void tidy(voi|
00000a10 64 29 0a 7b 0a 20 20 6f 73 5f 73 77 69 32 28 4f |d).{. os_swi2(O|
00000a20 53 5f 42 79 74 65 2c 20 31 31 32 2c 20 31 29 3b |S_Byte, 112, 1);|
00000a30 0a 20 20 6f 73 5f 73 77 69 32 28 4f 53 5f 42 79 |. os_swi2(OS_By|
00000a40 74 65 2c 20 31 31 33 2c 20 31 29 3b 0a 7d 0a 0a |te, 113, 1);.}..|
00000a50 76 6f 69 64 20 73 77 61 70 5f 62 61 6e 6b 73 28 |void swap_banks(|
00000a60 76 6f 69 64 29 0a 7b 0a 20 20 6f 73 5f 73 77 69 |void).{. os_swi|
00000a70 32 28 4f 53 5f 42 79 74 65 2c 20 31 31 33 2c 20 |2(OS_Byte, 113, |
00000a80 62 61 6e 6b 29 3b 0a 20 20 6f 73 5f 73 77 69 32 |bank);. os_swi2|
00000a90 28 4f 53 5f 42 79 74 65 2c 20 31 31 32 2c 20 62 |(OS_Byte, 112, b|
00000aa0 61 6e 6b 3d 33 2d 62 61 6e 6b 29 3b 0a 7d 0a 0a |ank=3-bank);.}..|
00000ab0 76 6f 69 64 20 70 72 65 70 61 72 65 5f 73 63 72 |void prepare_scr|
00000ac0 65 65 6e 28 76 6f 69 64 29 0a 7b 0a 20 20 62 61 |een(void).{. ba|
00000ad0 6e 6b 3d 31 3b 0a 20 20 6f 73 5f 73 77 69 32 28 |nk=1;. os_swi2(|
00000ae0 4f 53 5f 42 79 74 65 2c 20 31 31 32 2c 20 62 61 |OS_Byte, 112, ba|
00000af0 6e 6b 29 3b 0a 20 20 6f 73 5f 73 77 69 32 28 4f |nk);. os_swi2(O|
00000b00 53 5f 42 79 74 65 2c 20 31 31 33 2c 20 33 2d 62 |S_Byte, 113, 3-b|
00000b10 61 6e 6b 29 3b 0a 7d 0a 0a 76 6f 69 64 20 70 72 |ank);.}..void pr|
00000b20 65 73 73 28 69 6e 74 20 69 29 0a 7b 0a 20 20 66 |ess(int i).{. f|
00000b30 6f 72 20 28 3b 62 62 63 5f 69 6e 6b 65 79 28 69 |or (;bbc_inkey(i|
00000b40 29 21 3d 2d 31 3b 29 3b 0a 20 20 72 65 74 75 72 |)!=-1;);. retur|
00000b50 6e 3b 0a 7d 0a 0a 76 6f 69 64 20 72 65 6c 65 61 |n;.}..void relea|
00000b60 73 65 28 69 6e 74 20 69 29 0a 7b 0a 20 20 66 6f |se(int i).{. fo|
00000b70 72 20 28 3b 62 62 63 5f 69 6e 6b 65 79 28 69 29 |r (;bbc_inkey(i)|
00000b80 21 3d 30 3b 29 3b 0a 20 20 72 65 74 75 72 6e 3b |!=0;);. return;|
00000b90 0a 7d 0a 0a 42 4f 4f 4c 20 6b 62 68 69 74 28 76 |.}..BOOL kbhit(v|
00000ba0 6f 69 64 29 0a 7b 0a 20 20 72 65 74 75 72 6e 20 |oid).{. return |
00000bb0 62 62 63 5f 69 6e 6b 65 79 28 2d 39 39 29 3d 3d |bbc_inkey(-99)==|
00000bc0 2d 31 3b 0a 7d 0a 0a 76 6f 69 64 20 73 74 65 70 |-1;.}..void step|
00000bd0 28 76 6f 69 64 29 0a 7b 0a 20 20 69 66 20 28 62 |(void).{. if (b|
00000be0 62 63 5f 69 6e 6b 65 79 28 2d 38 32 29 29 20 73 |bc_inkey(-82)) s|
00000bf0 69 6e 67 6c 65 5f 73 74 65 70 3d 54 52 55 45 3b |ingle_step=TRUE;|
00000c00 0a 20 20 69 66 20 28 73 69 6e 67 6c 65 5f 73 74 |. if (single_st|
00000c10 65 70 29 20 66 6f 72 20 28 3b 20 73 69 6e 67 6c |ep) for (; singl|
00000c20 65 5f 73 74 65 70 3b 29 20 7b 0a 20 20 20 20 69 |e_step;) {. i|
00000c30 66 20 28 62 62 63 5f 69 6e 6b 65 79 28 2d 38 32 |f (bbc_inkey(-82|
00000c40 29 29 20 7b 0a 20 20 20 20 20 20 72 65 6c 65 61 |)) {. relea|
00000c50 73 65 28 2d 38 32 29 3b 0a 20 20 20 20 20 20 62 |se(-82);. b|
00000c60 72 65 61 6b 3b 0a 20 20 20 20 7d 0a 20 20 20 20 |reak;. }. |
00000c70 69 66 20 28 62 62 63 5f 69 6e 6b 65 79 28 2d 38 |if (bbc_inkey(-8|
00000c80 33 29 29 20 73 69 6e 67 6c 65 5f 73 74 65 70 3d |3)) single_step=|
00000c90 46 41 4c 53 45 3b 0a 20 20 7d 0a 7d 0a 0a 76 6f |FALSE;. }.}..vo|
00000ca0 69 64 20 73 65 65 64 5f 72 61 6e 64 31 36 28 76 |id seed_rand16(v|
00000cb0 6f 69 64 29 0a 7b 0a 20 20 69 6e 74 20 76 3d 63 |oid).{. int v=c|
00000cc0 6c 6f 63 6b 28 29 20 26 20 30 78 66 66 3b 0a 20 |lock() & 0xff;. |
00000cd0 20 76 7c 3d 76 3c 3c 38 3b 0a 20 20 73 72 61 6e | v|=v<<8;. sran|
00000ce0 64 31 36 28 76 20 7c 20 76 3c 3c 31 36 29 3b 0a |d16(v | v<<16);.|
00000cf0 7d 0a 0a 2f 2a 72 65 74 75 72 6e 73 20 31 36 62 |}../*returns 16b|
00000d00 66 70 20 6d 61 67 6e 69 74 75 64 65 20 6f 66 20 |fp magnitude of |
00000d10 76 65 63 74 6f 72 20 77 69 74 68 20 31 36 62 66 |vector with 16bf|
00000d20 70 20 63 6f 6d 70 6f 6e 65 6e 74 73 20 78 20 26 |p components x &|
00000d30 20 79 2a 2f 0a 69 6e 74 20 6d 61 67 6e 69 74 75 | y*/.int magnitu|
00000d40 64 65 28 69 6e 74 20 78 2c 20 69 6e 74 20 79 29 |de(int x, int y)|
00000d50 0a 7b 0a 20 20 69 6e 74 20 66 20 3d 20 73 71 72 |.{. int f = sqr|
00000d60 74 31 30 31 36 28 6d 75 6c 31 36 31 30 28 78 2c |t1016(mul1610(x,|
00000d70 78 29 2b 6d 75 6c 31 36 31 30 28 79 2c 79 29 29 |x)+mul1610(y,y))|
00000d80 3b 0a 20 20 69 66 20 28 66 3c 61 62 73 28 78 29 |;. if (f<abs(x)|
00000d90 29 20 66 3d 61 62 73 28 78 29 3b 09 2f 2a 63 6f |) f=abs(x);./*co|
00000da0 6d 70 65 6e 73 61 74 65 20 66 6f 72 20 73 6f 6d |mpensate for som|
00000db0 65 20 6e 61 73 74 79 20 75 6e 64 65 72 66 6c 6f |e nasty underflo|
00000dc0 77 20 70 72 6f 62 6c 65 6d 73 2a 2f 0a 20 20 69 |w problems*/. i|
00000dd0 66 20 28 66 3c 61 62 73 28 79 29 29 20 66 3d 61 |f (f<abs(y)) f=a|
00000de0 62 73 28 79 29 3b 09 2f 2a 77 69 74 68 20 61 62 |bs(y);./*with ab|
00000df0 6f 76 65 20 66 69 78 65 64 20 70 6f 69 6e 74 20 |ove fixed point |
00000e00 61 72 69 74 68 6d 65 74 69 63 2a 2f 0a 20 20 72 |arithmetic*/. r|
00000e10 65 74 75 72 6e 20 66 3c 6f 6e 65 2f 32 35 36 20 |eturn f<one/256 |
00000e20 3f 20 6f 6e 65 2f 32 35 36 20 3a 20 66 3b 0a 7d |? one/256 : f;.}|
00000e30 0a 0a 69 6e 74 20 6e 65 61 72 65 73 74 73 5f 73 |..int nearests_s|
00000e40 71 72 74 28 69 6e 74 20 69 29 0a 7b 0a 20 20 69 |qrt(int i).{. i|
00000e50 6e 74 20 66 20 3d 20 73 71 72 74 31 30 31 36 28 |nt f = sqrt1016(|
00000e60 62 6f 69 64 5b 69 5d 2e 64 6d 29 3b 0a 20 20 69 |boid[i].dm);. i|
00000e70 66 20 28 66 3c 61 62 73 28 62 6f 69 64 5b 62 6f |f (f<abs(boid[bo|
00000e80 69 64 5b 69 5d 2e 69 6d 5d 2e 78 2d 62 6f 69 64 |id[i].im].x-boid|
00000e90 5b 69 5d 2e 78 29 29 20 66 3d 61 62 73 28 62 6f |[i].x)) f=abs(bo|
00000ea0 69 64 5b 62 6f 69 64 5b 69 5d 2e 69 6d 5d 2e 78 |id[boid[i].im].x|
00000eb0 2d 62 6f 69 64 5b 69 5d 2e 78 29 3b 0a 20 20 69 |-boid[i].x);. i|
00000ec0 66 20 28 66 3c 61 62 73 28 62 6f 69 64 5b 62 6f |f (f<abs(boid[bo|
00000ed0 69 64 5b 69 5d 2e 69 6d 5d 2e 79 2d 62 6f 69 64 |id[i].im].y-boid|
00000ee0 5b 69 5d 2e 79 29 29 20 66 3d 61 62 73 28 62 6f |[i].y)) f=abs(bo|
00000ef0 69 64 5b 62 6f 69 64 5b 69 5d 2e 69 6d 5d 2e 79 |id[boid[i].im].y|
00000f00 2d 62 6f 69 64 5b 69 5d 2e 79 29 3b 0a 20 20 72 |-boid[i].y);. r|
00000f10 65 74 75 72 6e 20 66 3c 6f 6e 65 2f 32 35 36 20 |eturn f<one/256 |
00000f20 3f 20 6f 6e 65 2f 32 35 36 20 3a 20 66 3b 0a 7d |? one/256 : f;.}|
00000f30 0a 0a 2f 2a 27 62 6f 75 6e 63 65 27 20 76 65 6c |../*'bounce' vel|
00000f40 6f 63 69 74 79 20 76 69 61 20 61 70 70 72 6f 61 |ocity via approa|
00000f50 63 68 20 76 65 63 74 6f 72 2c 20 6e 62 20 78 2c |ch vector, nb x,|
00000f60 79 2c 76 78 2c 76 79 20 31 36 62 66 70 2c 20 77 |y,vx,vy 16bfp, w|
00000f70 68 69 6c 65 20 6d 3d 78 2a 78 2b 79 2a 79 20 31 |hile m=x*x+y*y 1|
00000f80 30 62 66 70 2a 2f 0a 76 6f 69 64 20 62 6f 75 6e |0bfp*/.void boun|
00000f90 63 65 28 69 6e 74 20 78 2c 20 69 6e 74 20 79 2c |ce(int x, int y,|
00000fa0 20 69 6e 74 20 2a 76 78 2c 20 69 6e 74 20 2a 76 | int *vx, int *v|
00000fb0 79 2c 20 69 6e 74 20 6d 29 0a 7b 0a 20 20 69 6e |y, int m).{. in|
00000fc0 74 20 20 73 20 3d 20 6d 75 6c 31 36 31 30 28 78 |t s = mul1610(x|
00000fd0 2c 20 2a 76 78 29 20 2b 20 6d 75 6c 31 36 31 30 |, *vx) + mul1610|
00000fe0 28 79 2c 20 2a 76 79 29 3b 0a 20 20 69 66 20 28 |(y, *vy);. if (|
00000ff0 73 3e 30 29 20 7b 0a 20 20 20 20 20 20 20 73 20 |s>0) {. s |
00001000 3d 20 32 2a 64 69 76 5f 66 72 61 63 31 36 28 73 |= 2*div_frac16(s|
00001010 2c 20 6d 3d 3d 30 20 3f 20 31 20 3a 20 6d 29 3b |, m==0 ? 1 : m);|
00001020 0a 20 20 20 20 2a 76 78 20 2d 3d 20 6d 75 6c 5f |. *vx -= mul_|
00001030 66 72 61 63 31 36 28 78 2c 20 73 29 3b 0a 20 20 |frac16(x, s);. |
00001040 20 20 2a 76 79 20 2d 3d 20 6d 75 6c 5f 66 72 61 | *vy -= mul_fra|
00001050 63 31 36 28 79 2c 20 73 29 3b 0a 20 20 7d 0a 7d |c16(y, s);. }.}|
00001060 0a 0a 42 4f 4f 4c 20 69 6e 69 74 28 76 6f 69 64 |..BOOL init(void|
00001070 29 0a 7b 0a 20 20 69 6e 74 20 69 2c 20 6a 3b 0a |).{. int i, j;.|
00001080 20 20 61 74 65 78 69 74 28 74 69 64 79 29 3b 0a | atexit(tidy);.|
00001090 20 20 76 67 61 20 3d 20 72 65 61 64 5f 6d 6f 6e | vga = read_mon|
000010a0 69 74 6f 72 5f 74 79 70 65 28 29 3d 3d 6d 75 6c |itor_type()==mul|
000010b0 74 69 20 3f 20 54 52 55 45 20 3a 20 46 41 4c 53 |ti ? TRUE : FALS|
000010c0 45 3b 0a 20 20 6d 6f 64 65 20 3d 20 76 67 61 20 |E;. mode = vga |
000010d0 3f 20 31 38 20 3a 20 30 3b 0a 20 20 74 69 64 79 |? 18 : 0;. tidy|
000010e0 28 29 3b 0a 20 20 62 62 63 5f 6d 6f 64 65 28 6d |();. bbc_mode(m|
000010f0 6f 64 65 2b 31 32 38 29 3b 0a 20 20 62 62 63 5f |ode+128);. bbc_|
00001100 6d 6f 64 65 28 6d 6f 64 65 29 3b 0a 20 20 62 62 |mode(mode);. bb|
00001110 63 5f 63 75 72 73 6f 72 28 30 29 3b 0a 20 20 6f |c_cursor(0);. o|
00001120 73 5f 63 6c 69 28 22 70 6f 69 6e 74 65 72 22 29 |s_cli("pointer")|
00001130 3b 0a 20 20 62 62 63 5f 6f 72 69 67 69 6e 28 36 |;. bbc_origin(6|
00001140 34 30 2c 35 31 32 29 3b 0a 20 20 70 6f 69 6e 74 |40,512);. point|
00001150 65 72 5f 72 65 73 65 74 5f 73 68 61 70 65 28 29 |er_reset_shape()|
00001160 3b 0a 20 20 72 65 6c 65 61 73 65 28 2d 39 39 29 |;. release(-99)|
00001170 3b 0a 20 20 6f 73 5f 73 77 69 32 28 4f 53 5f 42 |;. os_swi2(OS_B|
00001180 79 74 65 2c 20 31 35 2c 20 31 29 3b 0a 20 20 64 |yte, 15, 1);. d|
00001190 6f 20 7b 0a 20 20 20 20 70 72 69 6e 74 66 28 22 |o {. printf("|
000011a0 50 6c 65 61 73 65 20 65 6e 74 65 72 20 6e 75 6d |Please enter num|
000011b0 62 65 72 20 6f 66 20 62 6f 69 64 73 20 28 6d 69 |ber of boids (mi|
000011c0 6e 20 32 2c 20 73 75 67 67 65 73 74 20 32 34 2b |n 2, suggest 24+|
000011d0 29 20 22 29 3b 0a 20 20 20 20 73 63 61 6e 66 28 |) ");. scanf(|
000011e0 22 25 69 22 2c 20 26 6e 29 3b 0a 20 20 7d 20 77 |"%i", &n);. } w|
000011f0 68 69 6c 65 20 28 6e 3c 32 29 3b 0a 20 20 64 6f |hile (n<2);. do|
00001200 20 7b 0a 20 20 20 20 70 72 69 6e 74 66 28 22 50 | {. printf("P|
00001210 6c 65 61 73 65 20 65 6e 74 65 72 20 6e 75 6d 62 |lease enter numb|
00001220 65 72 20 6f 66 20 70 69 6c 6c 61 72 73 20 28 31 |er of pillars (1|
00001230 20 74 6f 20 31 30 30 2c 20 73 75 67 67 65 73 74 | to 100, suggest|
00001240 20 34 29 20 22 29 3b 0a 20 20 20 20 73 63 61 6e | 4) ");. scan|
00001250 66 28 22 25 69 22 2c 20 26 70 6e 29 3b 0a 20 20 |f("%i", &pn);. |
00001260 7d 20 77 68 69 6c 65 20 28 70 6e 3c 31 20 7c 7c |} while (pn<1 |||
00001270 20 70 6e 3e 31 30 30 29 3b 0a 20 20 64 6f 20 7b | pn>100);. do {|
00001280 0a 20 20 20 20 70 72 69 6e 74 66 28 22 50 6c 65 |. printf("Ple|
00001290 61 73 65 20 65 6e 74 65 72 20 62 6f 69 64 20 73 |ase enter boid s|
000012a0 69 7a 65 20 28 31 20 74 6f 20 38 2c 20 73 75 67 |ize (1 to 8, sug|
000012b0 67 65 73 74 20 34 29 20 22 29 3b 0a 20 20 20 20 |gest 4) ");. |
000012c0 73 63 61 6e 66 28 22 25 69 22 2c 20 26 67 29 3b |scanf("%i", &g);|
000012d0 0a 20 20 7d 20 77 68 69 6c 65 20 28 67 3c 31 20 |. } while (g<1 |
000012e0 7c 7c 20 67 3e 38 29 3b 0a 20 20 64 6f 20 7b 0a ||| g>8);. do {.|
000012f0 20 20 20 20 70 72 69 6e 74 66 28 22 50 6c 65 61 | printf("Plea|
00001300 73 65 20 65 6e 74 65 72 20 73 65 65 64 20 66 6f |se enter seed fo|
00001310 72 20 72 61 6e 64 6f 6d 20 69 6e 69 74 69 61 6c |r random initial|
00001320 69 73 61 74 69 6f 6e 20 28 61 6e 79 20 6e 6f 6e |isation (any non|
00001330 2d 7a 65 72 6f 20 69 6e 74 65 67 65 72 2c 5c 6e |-zero integer,\n|
00001340 6f 72 20 30 20 66 6f 72 20 61 20 27 72 61 6e 64 |or 0 for a 'rand|
00001350 6f 6d 27 20 73 65 65 64 3b 20 74 72 79 20 31 30 |om' seed; try 10|
00001360 31 29 20 22 29 3b 0a 20 20 20 20 73 63 61 6e 66 |1) ");. scanf|
00001370 28 22 25 69 22 2c 20 26 69 29 3b 0a 20 20 7d 20 |("%i", &i);. } |
00001380 77 68 69 6c 65 20 28 46 41 4c 53 45 29 3b 0a 0a |while (FALSE);..|
00001390 20 20 69 66 20 28 69 29 20 73 72 61 6e 64 31 36 | if (i) srand16|
000013a0 28 7e 28 69 5e 28 69 3c 3c 31 36 29 29 29 3b 0a |(~(i^(i<<16)));.|
000013b0 20 20 65 6c 73 65 20 73 65 65 64 5f 72 61 6e 64 | else seed_rand|
000013c0 31 36 28 29 3b 0a 20 20 72 63 3d 35 2a 67 2a 6f |16();. rc=5*g*o|
000013d0 6e 65 3b 09 09 2f 2a 72 61 64 69 75 73 20 66 6f |ne;../*radius fo|
000013e0 72 20 63 6f 6c 6c 69 73 69 6f 6e 20 64 65 74 65 |r collision dete|
000013f0 63 74 69 6f 6e 2a 2f 0a 20 20 72 6d 3d 38 2a 67 |ction*/. rm=8*g|
00001400 2a 6f 6e 65 3b 09 09 2f 2a 72 61 64 69 75 73 20 |*one;../*radius |
00001410 66 6f 72 20 76 65 6c 6f 63 69 74 79 20 6d 61 74 |for velocity mat|
00001420 63 68 69 6e 67 2a 2f 0a 20 20 72 6c 3d 32 30 2a |ching*/. rl=20*|
00001430 67 2a 6f 6e 65 3b 09 09 2f 2a 72 61 64 69 75 73 |g*one;../*radius|
00001440 20 6f 66 20 6c 6f 63 61 6c 65 2a 2f 0a 20 20 72 | of locale*/. r|
00001450 63 32 3d 6d 75 6c 31 36 31 30 28 72 63 2c 72 63 |c2=mul1610(rc,rc|
00001460 29 3b 0a 20 20 72 6c 32 3d 6d 75 6c 31 36 31 30 |);. rl2=mul1610|
00001470 28 72 6c 2c 72 6c 29 3b 0a 20 20 69 66 20 28 70 |(rl,rl);. if (p|
00001480 69 6c 6c 61 72 29 20 7b 0a 20 20 20 20 66 72 65 |illar) {. fre|
00001490 65 28 70 69 6c 6c 61 72 29 3b 0a 20 20 20 20 70 |e(pillar);. p|
000014a0 69 6c 6c 61 72 3d 30 3b 0a 20 20 7d 0a 20 20 69 |illar=0;. }. i|
000014b0 66 20 28 62 6f 69 64 29 20 7b 0a 20 20 20 20 66 |f (boid) {. f|
000014c0 72 65 65 28 62 6f 69 64 29 3b 0a 20 20 20 20 62 |ree(boid);. b|
000014d0 6f 69 64 3d 30 3b 0a 20 20 7d 0a 20 20 69 66 20 |oid=0;. }. if |
000014e0 28 67 72 69 64 29 20 7b 0a 20 20 20 20 66 72 65 |(grid) {. fre|
000014f0 65 28 67 72 69 64 29 3b 0a 20 20 20 20 67 72 69 |e(grid);. gri|
00001500 64 3d 30 3b 0a 20 20 7d 0a 20 20 69 66 20 28 62 |d=0;. }. if (b|
00001510 6f 69 64 67 6e 6f 64 65 29 20 7b 0a 20 20 20 20 |oidgnode) {. |
00001520 66 72 65 65 28 62 6f 69 64 67 6e 6f 64 65 29 3b |free(boidgnode);|
00001530 0a 20 20 20 20 62 6f 69 64 67 6e 6f 64 65 3d 30 |. boidgnode=0|
00001540 3b 0a 20 20 7d 0a 20 20 69 66 20 28 67 6d 61 73 |;. }. if (gmas|
00001550 6b 29 20 7b 0a 20 20 20 20 66 72 65 65 28 67 6d |k) {. free(gm|
00001560 61 73 6b 29 3b 0a 20 20 20 20 67 6d 61 73 6b 3d |ask);. gmask=|
00001570 30 3b 0a 20 20 7d 0a 20 20 69 66 20 28 70 69 6c |0;. }. if (pil|
00001580 6c 61 72 20 3d 20 63 61 6c 6c 6f 63 28 70 6e 2c |lar = calloc(pn,|
00001590 20 73 69 7a 65 6f 66 28 70 69 6c 6c 61 72 5f 64 | sizeof(pillar_d|
000015a0 61 74 61 29 29 2c 20 70 69 6c 6c 61 72 3d 3d 30 |ata)), pillar==0|
000015b0 29 20 7b 0a 20 20 20 20 77 65 72 72 28 77 65 72 |) {. werr(wer|
000015c0 72 74 65 72 6d 2c 20 22 49 6e 73 75 66 66 69 63 |rterm, "Insuffic|
000015d0 69 65 6e 74 20 6d 65 6d 6f 72 79 22 29 3b 0a 20 |ient memory");. |
000015e0 20 20 20 72 65 74 75 72 6e 20 46 41 4c 53 45 3b | return FALSE;|
000015f0 0a 20 20 7d 0a 20 20 69 66 20 28 62 6f 69 64 20 |. }. if (boid |
00001600 20 20 3d 20 63 61 6c 6c 6f 63 28 20 6e 2c 20 73 | = calloc( n, s|
00001610 69 7a 65 6f 66 28 20 20 62 6f 69 64 5f 64 61 74 |izeof( boid_dat|
00001620 61 29 29 2c 20 20 20 62 6f 69 64 3d 3d 30 29 20 |a)), boid==0) |
00001630 7b 0a 20 20 20 20 77 65 72 72 28 77 65 72 72 74 |{. werr(werrt|
00001640 65 72 6d 2c 20 22 49 6e 73 75 66 66 69 63 69 65 |erm, "Insufficie|
00001650 6e 74 20 6d 65 6d 6f 72 79 22 29 3b 0a 20 20 20 |nt memory");. |
00001660 20 72 65 74 75 72 6e 20 46 41 4c 53 45 3b 0a 20 | return FALSE;. |
00001670 20 7d 0a 20 20 67 73 69 7a 65 20 3d 20 72 63 3b | }. gsize = rc;|
00001680 0a 20 20 6c 67 73 69 7a 65 3d 20 28 69 6e 74 29 |. lgsize= (int)|
00001690 28 6c 6f 67 28 66 70 74 6f 64 28 67 73 69 7a 65 |(log(fptod(gsize|
000016a0 29 29 2f 30 2e 36 39 33 31 35 20 2b 20 31 2e 30 |))/0.69315 + 1.0|
000016b0 29 3b 0a 20 20 67 73 69 7a 65 20 3d 20 31 3c 3c |);. gsize = 1<<|
000016c0 6c 67 73 69 7a 65 3b 09 09 2f 2a 72 6f 75 6e 64 |lgsize;../*round|
000016d0 20 69 74 20 75 70 20 74 6f 20 61 20 70 6f 77 65 | it up to a powe|
000016e0 72 20 6f 66 20 32 2a 2f 0a 20 20 67 72 6c 20 20 |r of 2*/. grl |
000016f0 20 3d 20 28 72 6c 2f 6f 6e 65 29 2f 67 73 69 7a | = (rl/one)/gsiz|
00001700 65 20 2b 20 31 3b 0a 20 20 6d 61 78 67 78 20 3d |e + 1;. maxgx =|
00001710 20 31 2b 31 32 38 30 2f 67 73 69 7a 65 3b 0a 20 | 1+1280/gsize;. |
00001720 20 6d 61 78 67 79 20 3d 20 31 2b 31 30 32 34 2f | maxgy = 1+1024/|
00001730 67 73 69 7a 65 3b 0a 20 20 69 66 20 28 67 6d 61 |gsize;. if (gma|
00001740 73 6b 20 3d 20 63 61 6c 6c 6f 63 28 28 67 72 6c |sk = calloc((grl|
00001750 2b 31 29 2a 28 67 72 6c 2b 31 29 2c 20 73 69 7a |+1)*(grl+1), siz|
00001760 65 6f 66 28 42 4f 4f 4c 29 29 2c 20 67 6d 61 73 |eof(BOOL)), gmas|
00001770 6b 3d 3d 30 29 20 7b 0a 20 20 20 20 77 65 72 72 |k==0) {. werr|
00001780 28 77 65 72 72 74 65 72 6d 2c 20 22 49 6e 73 75 |(werrterm, "Insu|
00001790 66 66 69 63 69 65 6e 74 20 6d 65 6d 6f 72 79 22 |fficient memory"|
000017a0 29 3b 0a 20 20 20 20 72 65 74 75 72 6e 20 46 41 |);. return FA|
000017b0 4c 53 45 3b 0a 20 20 7d 0a 20 20 66 6f 72 20 28 |LSE;. }. for (|
000017c0 6a 3d 30 3b 20 6a 3c 3d 67 72 6c 3b 20 6a 2b 2b |j=0; j<=grl; j++|
000017d0 29 0a 20 20 20 20 66 6f 72 20 28 69 3d 30 3b 20 |). for (i=0; |
000017e0 69 3c 3d 67 72 6c 3b 20 69 2b 2b 29 0a 20 20 20 |i<=grl; i++). |
000017f0 20 20 20 67 6d 61 73 6b 5b 69 2b 28 67 72 6c 2b | gmask[i+(grl+|
00001800 31 29 2a 6a 5d 20 3d 20 28 20 69 3e 30 20 26 26 |1)*j] = ( i>0 &&|
00001810 20 6a 3e 30 20 26 26 20 28 28 69 2d 31 29 2a 28 | j>0 && ((i-1)*(|
00001820 69 2d 31 29 2b 28 6a 2d 31 29 2a 28 6a 2d 31 29 |i-1)+(j-1)*(j-1)|
00001830 29 2a 67 73 69 7a 65 2a 67 73 69 7a 65 3e 28 72 |)*gsize*gsize>(r|
00001840 6c 2f 6f 6e 65 29 2a 28 72 6c 2f 6f 6e 65 29 20 |l/one)*(rl/one) |
00001850 29 20 3f 20 46 41 4c 53 45 20 3a 20 54 52 55 45 |) ? FALSE : TRUE|
00001860 3b 0a 20 20 69 66 20 28 67 72 69 64 20 3d 20 63 |;. if (grid = c|
00001870 61 6c 6c 6f 63 28 28 6d 61 78 67 78 2b 31 29 2a |alloc((maxgx+1)*|
00001880 28 6d 61 78 67 79 2b 31 29 2c 20 73 69 7a 65 6f |(maxgy+1), sizeo|
00001890 66 28 67 6e 6f 64 65 20 2a 29 29 2c 20 67 72 69 |f(gnode *)), gri|
000018a0 64 3d 3d 30 29 20 7b 0a 20 20 20 20 77 65 72 72 |d==0) {. werr|
000018b0 28 77 65 72 72 74 65 72 6d 2c 20 22 49 6e 73 75 |(werrterm, "Insu|
000018c0 66 66 69 63 69 65 6e 74 20 6d 65 6d 6f 72 79 22 |fficient memory"|
000018d0 29 3b 0a 20 20 20 20 72 65 74 75 72 6e 20 46 41 |);. return FA|
000018e0 4c 53 45 3b 0a 20 20 7d 0a 20 20 69 66 20 28 62 |LSE;. }. if (b|
000018f0 6f 69 64 67 6e 6f 64 65 20 3d 20 63 61 6c 6c 6f |oidgnode = callo|
00001900 63 28 20 6e 2c 20 73 69 7a 65 6f 66 28 67 6e 6f |c( n, sizeof(gno|
00001910 64 65 29 29 2c 20 62 6f 69 64 67 6e 6f 64 65 3d |de)), boidgnode=|
00001920 3d 30 29 20 7b 0a 20 20 20 20 77 65 72 72 28 77 |=0) {. werr(w|
00001930 65 72 72 74 65 72 6d 2c 20 22 49 6e 73 75 66 66 |errterm, "Insuff|
00001940 69 63 69 65 6e 74 20 6d 65 6d 6f 72 79 22 29 3b |icient memory");|
00001950 0a 20 20 20 20 72 65 74 75 72 6e 20 46 41 4c 53 |. return FALS|
00001960 45 3b 0a 20 20 7d 0a 20 20 6d 63 3d 30 3b 0a 20 |E;. }. mc=0;. |
00001970 20 66 6f 72 20 28 69 3d 30 3b 20 69 3c 70 6e 3b | for (i=0; i<pn;|
00001980 20 69 2b 2b 29 20 7b 0a 20 20 20 20 70 69 6c 6c | i++) {. pill|
00001990 61 72 5b 69 5d 2e 78 20 20 3d 20 72 61 6e 64 31 |ar[i].x = rand1|
000019a0 36 28 29 2a 36 34 30 3b 0a 20 20 20 20 70 69 6c |6()*640;. pil|
000019b0 6c 61 72 5b 69 5d 2e 79 20 20 3d 20 72 61 6e 64 |lar[i].y = rand|
000019c0 31 36 28 29 2a 35 31 32 3b 0a 20 20 20 20 70 69 |16()*512;. pi|
000019d0 6c 6c 61 72 5b 69 5d 2e 72 20 20 3d 20 72 61 6e |llar[i].r = ran|
000019e0 64 75 31 36 28 29 2a 34 30 3b 0a 20 20 20 20 70 |du16()*40;. p|
000019f0 69 6c 6c 61 72 5b 69 5d 2e 72 32 20 3d 20 6d 75 |illar[i].r2 = mu|
00001a00 6c 31 36 31 30 28 70 69 6c 6c 61 72 5b 69 5d 2e |l1610(pillar[i].|
00001a10 72 2b 72 63 2f 32 2c 20 70 69 6c 6c 61 72 5b 69 |r+rc/2, pillar[i|
00001a20 5d 2e 72 2b 72 63 2f 32 29 3b 0a 20 20 7d 0a 20 |].r+rc/2);. }. |
00001a30 20 66 6f 72 20 28 69 3d 30 3b 20 69 3c 6e 3b 20 | for (i=0; i<n; |
00001a40 69 2b 2b 29 20 7b 0a 20 20 20 20 62 6f 69 64 5b |i++) {. boid[|
00001a50 69 5d 2e 78 20 20 3d 20 36 34 2a 67 2a 72 61 6e |i].x = 64*g*ran|
00001a60 64 31 36 28 29 3b 0a 20 20 20 20 62 6f 69 64 5b |d16();. boid[|
00001a70 69 5d 2e 79 20 20 3d 20 36 34 2a 67 2a 72 61 6e |i].y = 64*g*ran|
00001a80 64 31 36 28 29 3b 0a 20 20 20 20 62 6f 69 64 5b |d16();. boid[|
00001a90 69 5d 2e 76 78 20 3d 20 20 34 2a 67 2a 72 61 6e |i].vx = 4*g*ran|
00001aa0 64 75 31 36 28 29 3b 0a 20 20 20 20 62 6f 69 64 |du16();. boid|
00001ab0 5b 69 5d 2e 76 79 20 3d 20 20 32 2a 67 2a 72 61 |[i].vy = 2*g*ra|
00001ac0 6e 64 31 36 28 29 3b 0a 20 20 20 20 62 6f 69 64 |nd16();. boid|
00001ad0 5b 69 5d 2e 6d 76 20 3d 20 6d 61 67 6e 69 74 75 |[i].mv = magnitu|
00001ae0 64 65 28 62 6f 69 64 5b 69 5d 2e 76 78 2c 62 6f |de(boid[i].vx,bo|
00001af0 69 64 5b 69 5d 2e 76 79 29 3b 0a 20 20 20 20 62 |id[i].vy);. b|
00001b00 6f 69 64 5b 69 5d 2e 70 72 65 76 69 6f 75 73 20 |oid[i].previous |
00001b10 3d 20 62 6f 69 64 2b 69 2d 31 3b 09 2f 2a 73 69 |= boid+i-1;./*si|
00001b20 6e 63 65 20 69 6e 69 74 69 61 6c 6c 79 20 62 6f |nce initially bo|
00001b30 69 64 73 20 61 72 65 20 6c 69 6e 6b 65 64 20 69 |ids are linked i|
00001b40 6e 20 6d 65 6d 6f 72 79 20 6f 72 64 65 72 2a 2f |n memory order*/|
00001b50 0a 20 20 20 20 62 6f 69 64 5b 69 5d 2e 6e 65 78 |. boid[i].nex|
00001b60 74 20 20 20 20 20 3d 20 62 6f 69 64 2b 69 2b 31 |t = boid+i+1|
00001b70 3b 0a 20 20 7d 0a 20 20 68 09 09 09 3d 20 62 6f |;. }. h...= bo|
00001b80 69 64 3b 0a 20 20 62 6f 69 64 5b 30 5d 2e 70 72 |id;. boid[0].pr|
00001b90 65 76 69 6f 75 73 09 3d 20 26 7a 6c 6f 77 3b 0a |evious.= &zlow;.|
00001ba0 20 20 62 6f 69 64 5b 6e 2d 31 5d 2e 6e 65 78 74 | boid[n-1].next|
00001bb0 09 3d 20 26 7a 68 69 67 68 3b 0a 20 20 7a 6c 6f |.= &zhigh;. zlo|
00001bc0 77 2e 70 72 65 76 69 6f 75 73 09 09 3d 20 7a 6c |w.previous..= zl|
00001bd0 6f 77 2e 6e 65 78 74 09 3d 20 26 7a 6c 6f 77 3b |ow.next.= &zlow;|
00001be0 0a 20 20 7a 68 69 67 68 2e 70 72 65 76 69 6f 75 |. zhigh.previou|
00001bf0 73 09 3d 20 7a 68 69 67 68 2e 6e 65 78 74 09 3d |s.= zhigh.next.=|
00001c00 20 26 7a 68 69 67 68 3b 0a 20 20 7a 6c 6f 77 2e | &zhigh;. zlow.|
00001c10 78 09 09 3d 20 7a 6c 6f 77 2e 79 09 3d 20 2d 36 |x..= zlow.y.= -6|
00001c20 34 30 2a 6f 6e 65 3b 09 2f 2a 73 6d 61 6c 6c 65 |40*one;./*smalle|
00001c30 73 74 20 6e 75 6d 62 65 72 2a 2f 0a 20 20 7a 68 |st number*/. zh|
00001c40 69 67 68 2e 78 09 09 3d 20 7a 68 69 67 68 2e 79 |igh.x..= zhigh.y|
00001c50 09 3d 20 20 36 34 30 2a 6f 6e 65 3b 09 2f 2a 62 |.= 640*one;./*b|
00001c60 69 67 67 65 73 74 20 6e 75 6d 62 65 72 2a 2f 0a |iggest number*/.|
00001c70 20 20 70 72 65 70 61 72 65 5f 73 63 72 65 65 6e | prepare_screen|
00001c80 28 29 3b 0a 20 20 72 65 74 75 72 6e 20 54 52 55 |();. return TRU|
00001c90 45 3b 0a 7d 0a 0a 76 6f 69 64 20 63 68 65 63 6b |E;.}..void check|
00001ca0 5f 6d 6f 75 73 65 28 76 6f 69 64 29 0a 7b 0a 20 |_mouse(void).{. |
00001cb0 20 69 6e 74 20 78 2c 79 2c 7a 2c 20 69 2c 64 3b | int x,y,z, i,d;|
00001cc0 0a 20 20 6f 73 5f 73 77 69 33 72 28 4f 53 5f 4d |. os_swi3r(OS_M|
00001cd0 6f 75 73 65 2c 20 30 2c 30 2c 30 2c 20 26 78 2c |ouse, 0,0,0, &x,|
00001ce0 26 79 2c 26 7a 29 3b 0a 20 20 78 2a 3d 6f 6e 65 |&y,&z);. x*=one|
00001cf0 3b 0a 20 20 79 2a 3d 6f 6e 65 3b 0a 20 20 73 77 |;. y*=one;. sw|
00001d00 69 74 63 68 28 7a 29 20 7b 0a 20 20 20 20 63 61 |itch(z) {. ca|
00001d10 73 65 20 31 3a 0a 20 20 20 20 20 20 69 66 20 28 |se 1:. if (|
00001d20 70 69 6c 6c 61 72 5b 6d 63 5d 2e 72 3e 6f 6e 65 |pillar[mc].r>one|
00001d30 29 20 7b 0a 20 20 20 20 20 20 20 20 70 69 6c 6c |) {. pill|
00001d40 61 72 5b 6d 63 5d 2e 72 2d 3d 6f 6e 65 3b 0a 20 |ar[mc].r-=one;. |
00001d50 20 20 20 20 20 20 20 70 69 6c 6c 61 72 5b 6d 63 | pillar[mc|
00001d60 5d 2e 72 32 3d 6d 75 6c 31 36 31 30 28 70 69 6c |].r2=mul1610(pil|
00001d70 6c 61 72 5b 6d 63 5d 2e 72 2b 72 63 2f 32 2c 20 |lar[mc].r+rc/2, |
00001d80 70 69 6c 6c 61 72 5b 6d 63 5d 2e 72 2b 72 63 2f |pillar[mc].r+rc/|
00001d90 32 29 3b 0a 20 20 20 20 20 20 7d 0a 20 20 20 20 |2);. }. |
00001da0 20 20 62 72 65 61 6b 3b 0a 20 20 20 20 63 61 73 | break;. cas|
00001db0 65 20 32 3a 0a 20 20 20 20 20 20 69 66 20 28 70 |e 2:. if (p|
00001dc0 69 6c 6c 61 72 5b 6d 63 5d 2e 72 3c 6f 6e 65 2a |illar[mc].r<one*|
00001dd0 32 30 30 29 20 7b 0a 20 20 20 20 20 20 20 20 70 |200) {. p|
00001de0 69 6c 6c 61 72 5b 6d 63 5d 2e 72 2b 3d 6f 6e 65 |illar[mc].r+=one|
00001df0 3b 0a 20 20 20 20 20 20 20 20 70 69 6c 6c 61 72 |;. pillar|
00001e00 5b 6d 63 5d 2e 72 32 3d 6d 75 6c 31 36 31 30 28 |[mc].r2=mul1610(|
00001e10 70 69 6c 6c 61 72 5b 6d 63 5d 2e 72 2b 72 63 2f |pillar[mc].r+rc/|
00001e20 32 2c 20 70 69 6c 6c 61 72 5b 6d 63 5d 2e 72 2b |2, pillar[mc].r+|
00001e30 72 63 2f 32 29 3b 0a 20 20 20 20 20 20 7d 0a 20 |rc/2);. }. |
00001e40 20 20 20 20 20 62 72 65 61 6b 3b 0a 20 20 20 20 | break;. |
00001e50 63 61 73 65 20 34 3a 0a 20 20 20 20 20 20 66 6f |case 4:. fo|
00001e60 72 20 28 69 3d 6d 63 3b 20 69 3c 70 6e 3b 20 69 |r (i=mc; i<pn; i|
00001e70 2b 2b 29 20 7b 0a 20 20 20 20 20 20 20 20 69 66 |++) {. if|
00001e80 20 28 61 62 73 28 70 69 6c 6c 61 72 5b 69 5d 2e | (abs(pillar[i].|
00001e90 78 2d 78 29 3c 70 69 6c 6c 61 72 5b 69 5d 2e 72 |x-x)<pillar[i].r|
00001ea0 20 26 26 20 61 62 73 28 70 69 6c 6c 61 72 5b 69 | && abs(pillar[i|
00001eb0 5d 2e 79 2d 79 29 3c 70 69 6c 6c 61 72 5b 69 5d |].y-y)<pillar[i]|
00001ec0 2e 72 29 20 7b 0a 20 20 20 20 20 20 20 20 20 20 |.r) {. |
00001ed0 64 20 3d 20 6d 75 6c 31 36 31 30 28 70 69 6c 6c |d = mul1610(pill|
00001ee0 61 72 5b 69 5d 2e 78 2d 78 2c 70 69 6c 6c 61 72 |ar[i].x-x,pillar|
00001ef0 5b 69 5d 2e 78 2d 78 29 20 2b 20 6d 75 6c 31 36 |[i].x-x) + mul16|
00001f00 31 30 28 70 69 6c 6c 61 72 5b 69 5d 2e 79 2d 79 |10(pillar[i].y-y|
00001f10 2c 70 69 6c 6c 61 72 5b 69 5d 2e 79 2d 79 29 3b |,pillar[i].y-y);|
00001f20 0a 20 20 20 20 20 20 20 20 20 20 69 66 20 28 64 |. if (d|
00001f30 20 3c 20 70 69 6c 6c 61 72 5b 69 5d 2e 72 32 29 | < pillar[i].r2)|
00001f40 20 7b 0a 20 20 20 20 20 20 20 20 20 20 20 20 69 | {. i|
00001f50 2b 3d 30 78 31 30 30 30 30 3b 0a 20 20 20 20 20 |+=0x10000;. |
00001f60 20 20 20 20 20 20 20 62 72 65 61 6b 3b 0a 20 20 | break;. |
00001f70 20 20 20 20 20 20 20 20 7d 0a 20 20 20 20 20 20 | }. |
00001f80 20 20 7d 0a 20 20 20 20 20 20 20 20 69 66 20 28 | }. if (|
00001f90 69 3d 3d 6d 63 29 20 20 20 69 3d 2d 31 3b 0a 20 |i==mc) i=-1;. |
00001fa0 20 20 20 20 20 20 20 69 66 20 28 69 3d 3d 6d 63 | if (i==mc|
00001fb0 2d 31 29 20 69 3d 6d 63 3b 0a 20 20 20 20 20 20 |-1) i=mc;. |
00001fc0 7d 0a 20 20 20 20 20 20 69 66 20 28 69 26 30 78 |}. if (i&0x|
00001fd0 31 30 30 30 30 20 26 26 20 69 21 3d 30 78 31 30 |10000 && i!=0x10|
00001fe0 30 30 30 2b 6d 63 29 20 7b 0a 20 20 20 20 20 20 |000+mc) {. |
00001ff0 20 20 6d 63 20 3d 20 69 2d 30 78 31 30 30 30 30 | mc = i-0x10000|
00002000 3b 0a 20 20 20 20 20 20 20 20 62 62 63 5f 76 64 |;. bbc_vd|
00002010 75 28 37 29 3b 0a 20 20 20 20 20 20 7d 0a 20 20 |u(7);. }. |
00002020 20 20 20 20 65 6c 73 65 20 7b 0a 20 20 20 20 20 | else {. |
00002030 20 20 20 70 69 6c 6c 61 72 5b 6d 63 5d 2e 78 20 | pillar[mc].x |
00002040 3d 20 78 3b 0a 20 20 20 20 20 20 20 20 70 69 6c |= x;. pil|
00002050 6c 61 72 5b 6d 63 5d 2e 79 20 3d 20 79 3b 0a 20 |lar[mc].y = y;. |
00002060 20 20 20 20 20 7d 0a 20 20 20 20 20 20 62 72 65 | }. bre|
00002070 61 6b 3b 0a 20 20 7d 0a 7d 0a 0a 62 6f 69 64 5f |ak;. }.}..boid_|
00002080 64 61 74 61 20 2a 6d 65 72 67 65 28 62 6f 69 64 |data *merge(boid|
00002090 5f 64 61 74 61 20 2a 61 2c 20 62 6f 69 64 5f 64 |_data *a, boid_d|
000020a0 61 74 61 20 2a 62 2c 20 69 6e 74 20 6f 66 66 73 |ata *b, int offs|
000020b0 65 74 29 0a 7b 0a 20 20 62 6f 69 64 5f 64 61 74 |et).{. boid_dat|
000020c0 61 20 2a 63 3b 0a 20 20 63 20 3d 20 26 7a 6c 6f |a *c;. c = &zlo|
000020d0 77 3b 0a 20 20 64 6f 20 7b 0a 20 20 20 20 69 66 |w;. do {. if|
000020e0 20 28 20 2a 28 28 69 6e 74 20 2a 29 61 2b 6f 66 | ( *((int *)a+of|
000020f0 66 73 65 74 29 20 3c 20 2a 28 28 69 6e 74 20 2a |fset) < *((int *|
00002100 29 62 2b 6f 66 66 73 65 74 29 20 29 20 7b 0a 20 |)b+offset) ) {. |
00002110 20 20 20 20 20 63 2d 3e 6e 65 78 74 20 3d 20 61 | c->next = a|
00002120 3b 0a 20 20 20 20 20 20 61 2d 3e 70 72 65 76 69 |;. a->previ|
00002130 6f 75 73 20 3d 20 63 3b 0a 20 20 20 20 20 20 63 |ous = c;. c|
00002140 20 3d 20 61 3b 0a 20 20 20 20 20 20 61 20 3d 20 | = a;. a = |
00002150 61 2d 3e 6e 65 78 74 3b 0a 20 20 20 20 7d 0a 20 |a->next;. }. |
00002160 20 20 20 65 6c 73 65 20 7b 0a 20 20 20 20 20 20 | else {. |
00002170 63 2d 3e 6e 65 78 74 20 3d 20 62 3b 0a 20 20 20 |c->next = b;. |
00002180 20 20 20 62 2d 3e 70 72 65 76 69 6f 75 73 20 3d | b->previous =|
00002190 20 63 3b 0a 20 20 20 20 20 20 63 20 3d 20 62 3b | c;. c = b;|
000021a0 0a 20 20 20 20 20 20 62 20 3d 20 62 2d 3e 6e 65 |. b = b->ne|
000021b0 78 74 3b 0a 20 20 20 20 7d 0a 20 20 7d 20 77 68 |xt;. }. } wh|
000021c0 69 6c 65 20 28 63 20 21 3d 20 26 7a 68 69 67 68 |ile (c != &zhigh|
000021d0 29 3b 0a 20 20 63 20 3d 20 7a 6c 6f 77 2e 6e 65 |);. c = zlow.ne|
000021e0 78 74 3b 0a 20 20 7a 6c 6f 77 2e 6e 65 78 74 20 |xt;. zlow.next |
000021f0 3d 20 26 7a 6c 6f 77 3b 0a 20 20 7a 68 69 67 68 |= &zlow;. zhigh|
00002200 2e 70 72 65 76 69 6f 75 73 20 3d 20 26 7a 68 69 |.previous = &zhi|
00002210 67 68 3b 0a 20 20 72 65 74 75 72 6e 20 63 3b 0a |gh;. return c;.|
00002220 7d 0a 0a 62 6f 69 64 5f 64 61 74 61 20 2a 73 6f |}..boid_data *so|
00002230 72 74 5f 79 5f 6e 63 61 6c 63 63 6c 6f 73 65 73 |rt_y_ncalccloses|
00002240 74 28 62 6f 69 64 5f 64 61 74 61 20 2a 63 2c 20 |t(boid_data *c, |
00002250 69 6e 74 20 6e 29 0a 7b 0a 20 20 69 6e 74 20 6d |int n).{. int m|
00002260 69 64 64 6c 65 3b 0a 20 20 62 6f 69 64 5f 64 61 |iddle;. boid_da|
00002270 74 61 20 2a 61 2c 20 2a 62 3b 0a 20 20 73 74 61 |ta *a, *b;. sta|
00002280 74 69 63 20 69 6e 74 20 69 2c 20 64 3b 0a 20 20 |tic int i, d;. |
00002290 73 74 61 74 69 63 20 42 4f 4f 4c 20 6c 65 66 74 |static BOOL left|
000022a0 3b 20 20 0a 20 20 69 66 20 28 63 2d 3e 6e 65 78 |; . if (c->nex|
000022b0 74 3d 3d 26 7a 68 69 67 68 29 20 72 65 74 75 72 |t==&zhigh) retur|
000022c0 6e 20 63 3b 0a 20 20 61 20 3d 20 63 3b 0a 20 20 |n c;. a = c;. |
000022d0 66 6f 72 20 28 69 3d 32 3b 20 69 3c 3d 6e 2f 32 |for (i=2; i<=n/2|
000022e0 3b 20 69 2b 2b 29 20 63 3d 63 2d 3e 6e 65 78 74 |; i++) c=c->next|
000022f0 3b 0a 20 20 62 20 3d 20 63 2d 3e 6e 65 78 74 3b |;. b = c->next;|
00002300 0a 20 20 63 2d 3e 6e 65 78 74 20 3d 20 26 7a 68 |. c->next = &zh|
00002310 69 67 68 3b 0a 20 20 62 2d 3e 70 72 65 76 69 6f |igh;. b->previo|
00002320 75 73 20 3d 20 26 7a 6c 6f 77 3b 0a 20 20 6d 69 |us = &zlow;. mi|
00002330 64 64 6c 65 20 3d 20 62 2d 3e 78 3b 0a 20 20 63 |ddle = b->x;. c|
00002340 20 3d 20 6d 65 72 67 65 28 73 6f 72 74 5f 79 5f | = merge(sort_y_|
00002350 6e 63 61 6c 63 63 6c 6f 73 65 73 74 28 61 2c 20 |ncalcclosest(a, |
00002360 6e 2f 32 29 2c 20 73 6f 72 74 5f 79 5f 6e 63 61 |n/2), sort_y_nca|
00002370 6c 63 63 6c 6f 73 65 73 74 28 62 2c 20 6e 2d 6e |lcclosest(b, n-n|
00002380 2f 32 29 2c 20 26 61 2d 3e 79 20 2d 20 28 69 6e |/2), &a->y - (in|
00002390 74 20 2a 29 61 29 3b 0a 20 20 66 6f 72 20 28 61 |t *)a);. for (a|
000023a0 3d 63 3b 20 61 21 3d 26 7a 68 69 67 68 3b 20 61 |=c; a!=&zhigh; a|
000023b0 3d 61 2d 3e 6e 65 78 74 29 20 7b 0a 20 20 20 20 |=a->next) {. |
000023c0 69 66 20 28 73 71 75 61 72 65 31 36 31 30 28 61 |if (square1610(a|
000023d0 2d 3e 78 2d 6d 69 64 64 6c 65 29 20 3c 20 61 2d |->x-middle) < a-|
000023e0 3e 64 6d 29 20 7b 0a 20 20 20 20 20 20 6c 65 66 |>dm) {. lef|
000023f0 74 20 3d 20 61 2d 3e 78 3c 6d 69 64 64 6c 65 3b |t = a->x<middle;|
00002400 0a 20 20 20 20 20 20 66 6f 72 20 28 62 3d 61 2d |. for (b=a-|
00002410 3e 6e 65 78 74 3b 20 62 21 3d 26 7a 68 69 67 68 |>next; b!=&zhigh|
00002420 20 26 26 20 28 64 3d 73 71 75 61 72 65 31 36 31 | && (d=square161|
00002430 30 28 62 2d 3e 79 2d 61 2d 3e 79 29 29 3c 61 2d |0(b->y-a->y))<a-|
00002440 3e 64 6d 3b 20 62 3d 62 2d 3e 6e 65 78 74 29 20 |>dm; b=b->next) |
00002450 7b 0a 20 20 20 20 20 20 20 20 69 66 20 28 6c 65 |{. if (le|
00002460 66 74 20 26 26 20 62 2d 3e 78 3e 3d 6d 69 64 64 |ft && b->x>=midd|
00002470 6c 65 20 20 7c 7c 20 20 21 6c 65 66 74 20 26 26 |le || !left &&|
00002480 20 62 2d 3e 78 3c 3d 6d 69 64 64 6c 65 29 20 7b | b->x<=middle) {|
00002490 0a 20 20 20 20 20 20 20 20 20 20 64 2b 3d 73 71 |. d+=sq|
000024a0 75 61 72 65 31 36 31 30 28 62 2d 3e 78 2d 61 2d |uare1610(b->x-a-|
000024b0 3e 78 29 3b 0a 20 20 20 20 20 20 20 20 20 20 69 |>x);. i|
000024c0 66 20 28 64 3c 61 2d 3e 64 6d 29 20 7b 0a 20 20 |f (d<a->dm) {. |
000024d0 20 20 20 20 20 20 20 20 20 20 61 2d 3e 64 6d 20 | a->dm |
000024e0 3d 20 64 3b 0a 20 20 20 20 20 20 20 20 20 20 20 |= d;. |
000024f0 20 61 2d 3e 69 6d 20 3d 20 62 2d 62 6f 69 64 3b | a->im = b-boid;|
00002500 0a 20 20 20 20 20 20 20 20 20 20 7d 0a 20 20 20 |. }. |
00002510 20 20 20 20 20 20 20 69 66 20 28 64 3c 62 2d 3e | if (d<b->|
00002520 64 6d 29 20 7b 0a 20 20 20 20 20 20 20 20 20 20 |dm) {. |
00002530 20 20 62 2d 3e 64 6d 20 3d 20 64 3b 0a 20 20 20 | b->dm = d;. |
00002540 20 20 20 20 20 20 20 20 20 62 2d 3e 69 6d 20 3d | b->im =|
00002550 20 61 2d 62 6f 69 64 3b 0a 20 20 20 20 20 20 20 | a-boid;. |
00002560 20 20 20 7d 0a 20 20 20 20 20 20 20 20 7d 0a 20 | }. }. |
00002570 20 20 20 20 20 7d 0a 20 20 20 20 20 20 66 6f 72 | }. for|
00002580 20 28 62 3d 61 2d 3e 70 72 65 76 69 6f 75 73 3b | (b=a->previous;|
00002590 20 62 21 3d 26 7a 6c 6f 77 20 26 26 20 28 64 3d | b!=&zlow && (d=|
000025a0 73 71 75 61 72 65 31 36 31 30 28 62 2d 3e 79 2d |square1610(b->y-|
000025b0 61 2d 3e 79 29 29 3c 61 2d 3e 64 6d 3b 20 62 3d |a->y))<a->dm; b=|
000025c0 62 2d 3e 70 72 65 76 69 6f 75 73 29 20 7b 0a 20 |b->previous) {. |
000025d0 20 20 20 20 20 20 20 69 66 20 28 6c 65 66 74 20 | if (left |
000025e0 26 26 20 62 2d 3e 78 3e 3d 6d 69 64 64 6c 65 20 |&& b->x>=middle |
000025f0 20 7c 7c 20 20 21 6c 65 66 74 20 26 26 20 62 2d | || !left && b-|
00002600 3e 78 3c 3d 6d 69 64 64 6c 65 29 20 7b 0a 20 20 |>x<=middle) {. |
00002610 20 20 20 20 20 20 20 20 64 2b 3d 73 71 75 61 72 | d+=squar|
00002620 65 31 36 31 30 28 62 2d 3e 78 2d 61 2d 3e 78 29 |e1610(b->x-a->x)|
00002630 3b 0a 20 20 20 20 20 20 20 20 20 20 69 66 20 28 |;. if (|
00002640 64 3c 61 2d 3e 64 6d 29 20 7b 0a 20 20 20 20 20 |d<a->dm) {. |
00002650 20 20 20 20 20 20 20 61 2d 3e 64 6d 20 3d 20 64 | a->dm = d|
00002660 3b 0a 20 20 20 20 20 20 20 20 20 20 20 20 61 2d |;. a-|
00002670 3e 69 6d 20 3d 20 62 2d 62 6f 69 64 3b 0a 20 20 |>im = b-boid;. |
00002680 20 20 20 20 20 20 20 20 7d 0a 20 20 20 20 20 20 | }. |
00002690 20 20 20 20 69 66 20 28 64 3c 62 2d 3e 64 6d 29 | if (d<b->dm)|
000026a0 20 7b 0a 20 20 20 20 20 20 20 20 20 20 20 20 62 | {. b|
000026b0 2d 3e 64 6d 20 3d 20 64 3b 0a 20 20 20 20 20 20 |->dm = d;. |
000026c0 20 20 20 20 20 20 62 2d 3e 69 6d 20 3d 20 61 2d | b->im = a-|
000026d0 62 6f 69 64 3b 0a 20 20 20 20 20 20 20 20 20 20 |boid;. |
000026e0 7d 0a 20 20 20 20 20 20 20 20 7d 0a 20 20 20 20 |}. }. |
000026f0 20 20 7d 0a 20 20 20 20 7d 0a 20 20 7d 0a 20 20 | }. }. }. |
00002700 72 65 74 75 72 6e 20 63 3b 0a 7d 0a 0a 62 6f 69 |return c;.}..boi|
00002710 64 5f 64 61 74 61 20 2a 73 6f 72 74 5f 78 28 62 |d_data *sort_x(b|
00002720 6f 69 64 5f 64 61 74 61 20 2a 63 2c 20 69 6e 74 |oid_data *c, int|
00002730 20 6e 29 0a 7b 0a 20 20 69 6e 74 20 69 3b 0a 20 | n).{. int i;. |
00002740 20 62 6f 69 64 5f 64 61 74 61 20 2a 61 2c 20 2a | boid_data *a, *|
00002750 62 3b 0a 20 20 69 66 20 28 63 2d 3e 6e 65 78 74 |b;. if (c->next|
00002760 3d 3d 26 7a 68 69 67 68 29 20 72 65 74 75 72 6e |==&zhigh) return|
00002770 20 63 3b 0a 20 20 61 20 3d 20 63 3b 0a 20 20 66 | c;. a = c;. f|
00002780 6f 72 20 28 69 3d 32 3b 20 69 3c 3d 6e 2f 32 3b |or (i=2; i<=n/2;|
00002790 20 69 2b 2b 29 20 63 3d 63 2d 3e 6e 65 78 74 3b | i++) c=c->next;|
000027a0 0a 20 20 62 20 3d 20 63 2d 3e 6e 65 78 74 3b 0a |. b = c->next;.|
000027b0 20 20 63 2d 3e 6e 65 78 74 20 3d 20 26 7a 68 69 | c->next = &zhi|
000027c0 67 68 3b 0a 20 20 62 2d 3e 70 72 65 76 69 6f 75 |gh;. b->previou|
000027d0 73 20 3d 20 26 7a 6c 6f 77 3b 0a 20 20 63 20 3d |s = &zlow;. c =|
000027e0 20 6d 65 72 67 65 28 73 6f 72 74 5f 78 28 61 2c | merge(sort_x(a,|
000027f0 20 6e 2f 32 29 2c 20 73 6f 72 74 5f 78 28 62 2c | n/2), sort_x(b,|
00002800 20 6e 2d 6e 2f 32 29 2c 20 26 61 2d 3e 78 20 2d | n-n/2), &a->x -|
00002810 20 28 69 6e 74 20 2a 29 61 29 3b 0a 20 20 72 65 | (int *)a);. re|
00002820 74 75 72 6e 20 63 3b 0a 7d 0a 0a 76 6f 69 64 20 |turn c;.}..void |
00002830 6d 6f 76 65 5f 62 6f 69 64 73 28 76 6f 69 64 29 |move_boids(void)|
00002840 0a 7b 0a 20 20 69 6e 74 20 69 2c 20 6a 2c 20 64 |.{. int i, j, d|
00002850 3b 0a 20 20 69 6e 74 20 78 2c 20 79 2c 20 76 78 |;. int x, y, vx|
00002860 2c 20 76 79 3b 0a 20 20 69 6e 74 20 61 2c 20 62 |, vy;. int a, b|
00002870 3b 0a 20 20 69 6e 74 20 6b 2c 20 6c 2c 20 70 2c |;. int k, l, p,|
00002880 20 71 3b 0a 20 20 67 6e 6f 64 65 20 2a 74 3b 0a | q;. gnode *t;.|
00002890 20 20 62 6f 69 64 5f 64 61 74 61 20 2a 62 70 2c | boid_data *bp,|
000028a0 20 2a 62 70 65 3b 0a 20 20 66 6f 72 20 28 62 70 | *bpe;. for (bp|
000028b0 3d 62 6f 69 64 2c 62 70 65 3d 62 70 2b 6e 3b 20 |=boid,bpe=bp+n; |
000028c0 62 70 3c 62 70 65 3b 20 62 70 2b 2b 29 20 7b 0a |bp<bpe; bp++) {.|
000028d0 20 20 20 20 62 70 2d 3e 64 6d 3d 30 78 37 66 66 | bp->dm=0x7ff|
000028e0 66 66 66 66 66 3b 0a 20 20 20 20 62 70 2d 3e 61 |fffff;. bp->a|
000028f0 78 3d 62 70 2d 3e 61 79 3d 62 70 2d 3e 61 76 78 |x=bp->ay=bp->avx|
00002900 3d 62 70 2d 3e 61 76 79 3d 62 70 2d 3e 61 63 3d |=bp->avy=bp->ac=|
00002910 30 3b 0a 20 20 7d 0a 20 20 74 6e 32 3d 63 6c 6f |0;. }. tn2=clo|
00002920 63 6b 28 29 3b 0a 20 20 2f 2a 72 61 6e 67 65 20 |ck();. /*range |
00002930 63 68 65 63 6b 69 6e 67 2a 2f 0a 20 20 6d 65 6d |checking*/. mem|
00002940 73 65 74 28 67 72 69 64 2c 20 30 2c 20 73 69 7a |set(grid, 0, siz|
00002950 65 6f 66 28 67 6e 6f 64 65 20 2a 29 2a 28 6d 61 |eof(gnode *)*(ma|
00002960 78 67 78 2b 31 29 2a 28 6d 61 78 67 79 2b 31 29 |xgx+1)*(maxgy+1)|
00002970 29 3b 0a 20 20 66 6f 72 20 28 69 3d 30 3b 20 69 |);. for (i=0; i|
00002980 3c 6e 3b 20 69 2b 2b 29 20 7b 09 09 2f 2a 66 69 |<n; i++) {../*fi|
00002990 72 73 74 20 77 65 20 69 6e 73 65 72 74 20 61 6c |rst we insert al|
000029a0 6c 20 62 6f 69 64 73 20 69 6e 74 6f 20 67 72 69 |l boids into gri|
000029b0 64 2a 2f 0a 20 20 20 20 61 20 3d 20 78 74 6f 67 |d*/. a = xtog|
000029c0 69 28 62 6f 69 64 5b 69 5d 2e 78 29 3b 0a 20 20 |i(boid[i].x);. |
000029d0 20 20 69 66 20 28 61 3c 30 29 20 61 3d 30 3b 0a | if (a<0) a=0;.|
000029e0 20 20 20 20 69 66 20 28 61 3e 6d 61 78 67 78 29 | if (a>maxgx)|
000029f0 20 61 3d 6d 61 78 67 78 3b 0a 20 20 20 20 62 20 | a=maxgx;. b |
00002a00 3d 20 79 74 6f 67 69 28 62 6f 69 64 5b 69 5d 2e |= ytogi(boid[i].|
00002a10 79 29 3b 0a 20 20 20 20 69 66 20 28 62 3c 30 29 |y);. if (b<0)|
00002a20 20 62 3d 30 3b 0a 20 20 20 20 69 66 20 28 62 3e | b=0;. if (b>|
00002a30 6d 61 78 67 79 29 20 62 3d 6d 61 78 67 79 3b 20 |maxgy) b=maxgy; |
00002a40 20 0a 20 20 20 20 6a 20 3d 20 61 2b 28 6d 61 78 | . j = a+(max|
00002a50 67 78 2b 31 29 2a 62 3b 0a 20 20 20 20 62 6f 69 |gx+1)*b;. boi|
00002a60 64 67 6e 6f 64 65 5b 69 5d 2e 6e 65 78 74 20 3d |dgnode[i].next =|
00002a70 20 67 72 69 64 5b 6a 5d 3b 0a 20 20 20 20 67 72 | grid[j];. gr|
00002a80 69 64 5b 6a 5d 20 3d 20 62 6f 69 64 67 6e 6f 64 |id[j] = boidgnod|
00002a90 65 2b 69 3b 0a 20 20 7d 0a 20 20 66 6f 72 20 28 |e+i;. }. for (|
00002aa0 69 3d 30 3b 20 69 3c 6e 3b 20 69 2b 2b 29 20 7b |i=0; i<n; i++) {|
00002ab0 09 09 2f 2a 74 68 65 6e 20 77 65 20 72 61 6e 67 |../*then we rang|
00002ac0 65 20 63 68 65 63 6b 20 76 69 61 20 74 68 65 20 |e check via the |
00002ad0 67 72 69 64 2a 2f 0a 20 20 20 20 61 20 3d 20 78 |grid*/. a = x|
00002ae0 74 6f 67 69 28 62 6f 69 64 5b 69 5d 2e 78 29 3b |togi(boid[i].x);|
00002af0 0a 20 20 20 20 69 66 20 28 61 3c 30 29 20 61 3d |. if (a<0) a=|
00002b00 30 3b 0a 20 20 20 20 69 66 20 28 61 3e 6d 61 78 |0;. if (a>max|
00002b10 67 78 29 20 61 3d 6d 61 78 67 78 3b 0a 20 20 20 |gx) a=maxgx;. |
00002b20 20 62 20 3d 20 79 74 6f 67 69 28 62 6f 69 64 5b | b = ytogi(boid[|
00002b30 69 5d 2e 79 29 3b 0a 20 20 20 20 69 66 20 28 62 |i].y);. if (b|
00002b40 3c 30 29 20 62 3d 30 3b 0a 20 20 20 20 69 66 20 |<0) b=0;. if |
00002b50 28 62 3e 6d 61 78 67 79 29 20 62 3d 6d 61 78 67 |(b>maxgy) b=maxg|
00002b60 79 3b 20 20 0a 20 20 20 20 6b 20 3d 20 61 2d 67 |y; . k = a-g|
00002b70 72 6c 3c 30 20 3f 20 30 20 3a 20 61 2d 67 72 6c |rl<0 ? 0 : a-grl|
00002b80 3b 0a 20 20 20 20 6c 20 3d 20 62 2d 67 72 6c 3c |;. l = b-grl<|
00002b90 30 20 3f 20 30 20 3a 20 62 2d 67 72 6c 3b 0a 20 |0 ? 0 : b-grl;. |
00002ba0 20 20 20 70 20 3d 20 61 2b 67 72 6c 3e 6d 61 78 | p = a+grl>max|
00002bb0 67 78 20 3f 20 6d 61 78 67 78 20 3a 20 61 2b 67 |gx ? maxgx : a+g|
00002bc0 72 6c 3b 0a 20 20 20 20 71 20 3d 20 62 2b 67 72 |rl;. q = b+gr|
00002bd0 6c 3e 6d 61 78 67 79 20 3f 20 6d 61 78 67 79 20 |l>maxgy ? maxgy |
00002be0 3a 20 62 2b 67 72 6c 3b 0a 20 20 20 20 66 6f 72 |: b+grl;. for|
00002bf0 20 28 79 3d 6c 3b 20 79 3c 3d 71 3b 20 79 2b 2b | (y=l; y<=q; y++|
00002c00 29 0a 20 20 20 20 20 20 66 6f 72 20 28 78 3d 6b |). for (x=k|
00002c10 3b 20 78 3c 3d 70 3b 20 78 2b 2b 29 0a 20 20 20 |; x<=p; x++). |
00002c20 20 20 20 20 20 69 66 20 28 67 6d 61 73 6b 5b 61 | if (gmask[a|
00002c30 62 73 28 78 2d 61 29 2b 28 67 72 6c 2b 31 29 2a |bs(x-a)+(grl+1)*|
00002c40 61 62 73 28 79 2d 62 29 5d 29 20 7b 0a 20 20 20 |abs(y-b)]) {. |
00002c50 20 20 20 20 20 20 20 66 6f 72 20 28 74 3d 67 72 | for (t=gr|
00002c60 69 64 5b 78 2b 28 6d 61 78 67 78 2b 31 29 2a 79 |id[x+(maxgx+1)*y|
00002c70 5d 3b 20 74 21 3d 30 3b 20 74 3d 74 2d 3e 6e 65 |]; t!=0; t=t->ne|
00002c80 78 74 29 20 7b 0a 20 20 20 20 20 20 20 20 20 20 |xt) {. |
00002c90 20 20 6a 20 3d 20 74 2d 62 6f 69 64 67 6e 6f 64 | j = t-boidgnod|
00002ca0 65 3b 0a 20 20 20 20 20 20 20 20 20 20 20 20 69 |e;. i|
00002cb0 66 20 28 69 3c 6a 29 20 7b 0a 20 20 20 20 20 20 |f (i<j) {. |
00002cc0 20 20 20 20 20 20 20 20 64 20 3d 20 73 71 75 61 | d = squa|
00002cd0 72 65 31 36 31 30 28 62 6f 69 64 5b 69 5d 2e 78 |re1610(boid[i].x|
00002ce0 2d 62 6f 69 64 5b 6a 5d 2e 78 29 20 2b 20 73 71 |-boid[j].x) + sq|
00002cf0 75 61 72 65 31 36 31 30 28 62 6f 69 64 5b 69 5d |uare1610(boid[i]|
00002d00 2e 79 2d 62 6f 69 64 5b 6a 5d 2e 79 29 3b 0a 20 |.y-boid[j].y);. |
00002d10 20 20 20 20 20 20 20 20 20 20 20 20 20 69 66 20 | if |
00002d20 28 64 3c 72 6c 32 29 20 7b 0a 20 20 20 20 20 20 |(d<rl2) {. |
00002d30 20 20 20 20 20 20 20 20 20 20 62 6f 69 64 5b 69 | boid[i|
00002d40 5d 2e 61 78 20 20 2b 3d 20 62 6f 69 64 5b 6a 5d |].ax += boid[j]|
00002d50 2e 78 2d 62 6f 69 64 5b 69 5d 2e 78 3b 0a 20 20 |.x-boid[i].x;. |
00002d60 20 20 20 20 20 20 20 20 20 20 20 20 20 20 62 6f | bo|
00002d70 69 64 5b 69 5d 2e 61 79 20 20 2b 3d 20 62 6f 69 |id[i].ay += boi|
00002d80 64 5b 6a 5d 2e 79 2d 62 6f 69 64 5b 69 5d 2e 79 |d[j].y-boid[i].y|
00002d90 3b 0a 20 20 20 20 20 20 20 20 20 20 20 20 20 20 |;. |
00002da0 20 20 62 6f 69 64 5b 69 5d 2e 61 76 78 20 2b 3d | boid[i].avx +=|
00002db0 20 62 6f 69 64 5b 6a 5d 2e 76 78 3b 0a 20 20 20 | boid[j].vx;. |
00002dc0 20 20 20 20 20 20 20 20 20 20 20 20 20 62 6f 69 | boi|
00002dd0 64 5b 69 5d 2e 61 76 79 20 2b 3d 20 62 6f 69 64 |d[i].avy += boid|
00002de0 5b 6a 5d 2e 76 79 3b 0a 20 20 20 20 20 20 20 20 |[j].vy;. |
00002df0 20 20 20 20 20 20 20 20 62 6f 69 64 5b 69 5d 2e | boid[i].|
00002e00 61 63 20 20 2b 3d 20 31 3b 0a 20 20 20 20 20 20 |ac += 1;. |
00002e10 20 20 20 20 20 20 20 20 20 20 62 6f 69 64 5b 6a | boid[j|
00002e20 5d 2e 61 78 20 20 2b 3d 20 62 6f 69 64 5b 69 5d |].ax += boid[i]|
00002e30 2e 78 2d 62 6f 69 64 5b 6a 5d 2e 78 3b 0a 20 20 |.x-boid[j].x;. |
00002e40 20 20 20 20 20 20 20 20 20 20 20 20 20 20 62 6f | bo|
00002e50 69 64 5b 6a 5d 2e 61 79 20 20 2b 3d 20 62 6f 69 |id[j].ay += boi|
00002e60 64 5b 69 5d 2e 79 2d 62 6f 69 64 5b 6a 5d 2e 79 |d[i].y-boid[j].y|
00002e70 3b 0a 20 20 20 20 20 20 20 20 20 20 20 20 20 20 |;. |
00002e80 20 20 62 6f 69 64 5b 6a 5d 2e 61 76 78 20 2b 3d | boid[j].avx +=|
00002e90 20 62 6f 69 64 5b 69 5d 2e 76 78 3b 0a 20 20 20 | boid[i].vx;. |
00002ea0 20 20 20 20 20 20 20 20 20 20 20 20 20 62 6f 69 | boi|
00002eb0 64 5b 6a 5d 2e 61 76 79 20 2b 3d 20 62 6f 69 64 |d[j].avy += boid|
00002ec0 5b 69 5d 2e 76 79 3b 0a 20 20 20 20 20 20 20 20 |[i].vy;. |
00002ed0 20 20 20 20 20 20 20 20 62 6f 69 64 5b 6a 5d 2e | boid[j].|
00002ee0 61 63 20 20 2b 3d 20 31 3b 0a 20 20 20 20 20 20 |ac += 1;. |
00002ef0 20 20 20 20 20 20 20 20 7d 0a 20 20 20 20 20 20 | }. |
00002f00 20 20 20 20 20 20 7d 0a 20 20 20 20 20 20 20 20 | }. |
00002f10 20 20 7d 0a 20 20 20 20 20 20 20 20 7d 0a 20 20 | }. }. |
00002f20 7d 0a 20 20 2f 2a 6d 69 6e 69 6d 75 6d 20 64 69 |}. /*minimum di|
00002f30 73 74 61 6e 63 65 20 63 61 6c 63 75 6c 61 74 69 |stance calculati|
00002f40 6f 6e 2a 2f 0a 20 20 68 20 3d 20 73 6f 72 74 5f |on*/. h = sort_|
00002f50 78 28 68 2c 20 6e 29 3b 0a 20 20 68 20 3d 20 73 |x(h, n);. h = s|
00002f60 6f 72 74 5f 79 5f 6e 63 61 6c 63 63 6c 6f 73 65 |ort_y_ncalcclose|
00002f70 73 74 28 68 2c 20 6e 29 3b 0a 20 20 2f 2a 72 61 |st(h, n);. /*ra|
00002f80 6e 67 65 20 63 68 65 63 6b 69 6e 67 20 26 20 6d |nge checking & m|
00002f90 69 6e 69 6d 75 6d 20 64 69 73 74 61 6e 63 65 20 |inimum distance |
00002fa0 63 61 6c 63 75 6c 61 74 69 6f 6e 73 20 63 6f 6d |calculations com|
00002fb0 70 6c 65 74 65 2a 2f 0a 20 20 74 6e 32 3d 63 6c |plete*/. tn2=cl|
00002fc0 6f 63 6b 28 29 2d 74 6e 32 3b 0a 20 20 66 6f 72 |ock()-tn2;. for|
00002fd0 20 28 69 3d 30 3b 20 69 3c 6e 3b 20 69 2b 2b 29 | (i=0; i<n; i++)|
00002fe0 20 7b 0a 20 20 20 20 78 20 20 3d 20 62 6f 69 64 | {. x = boid|
00002ff0 5b 69 5d 2e 78 3b 0a 20 20 20 20 79 20 20 3d 20 |[i].x;. y = |
00003000 62 6f 69 64 5b 69 5d 2e 79 3b 0a 20 20 20 20 76 |boid[i].y;. v|
00003010 78 20 3d 20 62 6f 69 64 5b 69 5d 2e 76 78 3b 0a |x = boid[i].vx;.|
00003020 20 20 20 20 76 79 20 3d 20 62 6f 69 64 5b 69 5d | vy = boid[i]|
00003030 2e 76 79 3b 0a 20 20 20 20 69 66 20 28 62 6f 69 |.vy;. if (boi|
00003040 64 5b 69 5d 2e 61 63 3c 31 29 20 7b 0a 20 20 20 |d[i].ac<1) {. |
00003050 20 20 20 6a 20 3d 20 62 6f 69 64 5b 69 5d 2e 69 | j = boid[i].i|
00003060 6d 3b 0a 20 20 20 20 20 20 62 6f 69 64 5b 69 5d |m;. boid[i]|
00003070 2e 61 78 20 20 2b 3d 20 62 6f 69 64 5b 6a 5d 2e |.ax += boid[j].|
00003080 78 2d 78 3b 0a 20 20 20 20 20 20 62 6f 69 64 5b |x-x;. boid[|
00003090 69 5d 2e 61 79 20 20 2b 3d 20 62 6f 69 64 5b 6a |i].ay += boid[j|
000030a0 5d 2e 79 2d 79 3b 0a 20 20 20 20 20 20 62 6f 69 |].y-y;. boi|
000030b0 64 5b 69 5d 2e 61 76 78 20 2b 3d 20 62 6f 69 64 |d[i].avx += boid|
000030c0 5b 6a 5d 2e 76 78 3b 0a 20 20 20 20 20 20 62 6f |[j].vx;. bo|
000030d0 69 64 5b 69 5d 2e 61 76 79 20 2b 3d 20 62 6f 69 |id[i].avy += boi|
000030e0 64 5b 6a 5d 2e 76 79 3b 0a 20 20 20 20 20 20 62 |d[j].vy;. b|
000030f0 6f 69 64 5b 69 5d 2e 61 63 20 20 2b 3d 20 31 3b |oid[i].ac += 1;|
00003100 0a 20 20 20 20 7d 0a 20 20 20 20 69 66 20 28 78 |. }. if (x|
00003110 3c 72 63 2d 36 34 30 2a 6f 6e 65 20 7c 7c 20 78 |<rc-640*one || x|
00003120 3e 36 34 30 2a 6f 6e 65 2d 72 63 20 7c 7c 20 79 |>640*one-rc || y|
00003130 3c 72 63 2d 35 31 32 2a 6f 6e 65 20 7c 7c 20 79 |<rc-512*one || y|
00003140 3e 35 31 32 2a 6f 6e 65 2d 72 63 29 20 7b 0a 20 |>512*one-rc) {. |
00003150 20 20 20 20 20 69 66 20 28 78 3c 72 63 2d 36 34 | if (x<rc-64|
00003160 30 2a 6f 6e 65 26 26 76 78 3c 30 20 7c 7c 20 78 |0*one&&vx<0 || x|
00003170 3e 36 34 30 2a 6f 6e 65 2d 72 63 26 26 76 78 3e |>640*one-rc&&vx>|
00003180 30 29 20 76 78 3d 2d 76 78 3b 0a 20 20 20 20 20 |0) vx=-vx;. |
00003190 20 69 66 20 28 79 3c 72 63 2d 35 31 32 2a 6f 6e | if (y<rc-512*on|
000031a0 65 26 26 76 79 3c 30 20 7c 7c 20 79 3e 35 31 32 |e&&vy<0 || y>512|
000031b0 2a 6f 6e 65 2d 72 63 26 26 76 79 3e 30 29 20 76 |*one-rc&&vy>0) v|
000031c0 79 3d 2d 76 79 3b 0a 20 20 20 20 7d 0a 20 20 20 |y=-vy;. }. |
000031d0 20 65 6c 73 65 20 7b 0a 20 20 20 20 20 20 66 6f | else {. fo|
000031e0 72 20 28 6a 3d 30 3b 20 6a 3c 70 6e 3b 20 6a 2b |r (j=0; j<pn; j+|
000031f0 2b 29 20 7b 0a 20 20 20 20 20 20 20 20 69 66 20 |+) {. if |
00003200 28 61 62 73 28 70 69 6c 6c 61 72 5b 6a 5d 2e 78 |(abs(pillar[j].x|
00003210 2d 78 29 3c 70 69 6c 6c 61 72 5b 6a 5d 2e 72 20 |-x)<pillar[j].r |
00003220 26 26 20 61 62 73 28 70 69 6c 6c 61 72 5b 6a 5d |&& abs(pillar[j]|
00003230 2e 79 2d 79 29 3c 70 69 6c 6c 61 72 5b 6a 5d 2e |.y-y)<pillar[j].|
00003240 72 29 20 7b 0a 20 20 20 20 20 20 20 20 20 20 64 |r) {. d|
00003250 20 3d 20 6d 75 6c 31 36 31 30 28 70 69 6c 6c 61 | = mul1610(pilla|
00003260 72 5b 6a 5d 2e 78 2d 78 2c 70 69 6c 6c 61 72 5b |r[j].x-x,pillar[|
00003270 6a 5d 2e 78 2d 78 29 20 2b 20 6d 75 6c 31 36 31 |j].x-x) + mul161|
00003280 30 28 70 69 6c 6c 61 72 5b 6a 5d 2e 79 2d 79 2c |0(pillar[j].y-y,|
00003290 70 69 6c 6c 61 72 5b 6a 5d 2e 79 2d 79 29 3b 0a |pillar[j].y-y);.|
000032a0 20 20 20 20 20 20 20 20 20 20 69 66 20 28 64 20 | if (d |
000032b0 3c 20 70 69 6c 6c 61 72 5b 6a 5d 2e 72 32 29 20 |< pillar[j].r2) |
000032c0 7b 0a 20 20 20 20 20 20 20 20 20 20 20 20 6a 2b |{. j+|
000032d0 3d 30 78 31 30 30 30 30 3b 0a 20 20 20 20 20 20 |=0x10000;. |
000032e0 20 20 20 20 20 20 62 72 65 61 6b 3b 0a 20 20 20 | break;. |
000032f0 20 20 20 20 20 20 20 7d 0a 20 20 20 20 20 20 20 | }. |
00003300 20 7d 0a 20 20 20 20 20 20 7d 0a 20 20 20 20 20 | }. }. |
00003310 20 69 66 20 28 6a 20 26 20 30 78 31 30 30 30 30 | if (j & 0x10000|
00003320 29 20 7b 0a 20 20 20 20 20 20 20 20 6a 2d 3d 30 |) {. j-=0|
00003330 78 31 30 30 30 30 3b 0a 20 20 20 20 20 20 20 20 |x10000;. |
00003340 62 6f 75 6e 63 65 28 70 69 6c 6c 61 72 5b 6a 5d |bounce(pillar[j]|
00003350 2e 78 2d 78 2c 20 70 69 6c 6c 61 72 5b 6a 5d 2e |.x-x, pillar[j].|
00003360 79 2d 79 2c 20 26 76 78 2c 20 26 76 79 2c 20 64 |y-y, &vx, &vy, d|
00003370 29 3b 0a 20 20 20 20 20 20 7d 0a 20 20 20 20 20 |);. }. |
00003380 20 65 6c 73 65 20 69 66 20 28 62 6f 69 64 5b 69 | else if (boid[i|
00003390 5d 2e 64 6d 3c 72 63 32 29 20 62 6f 75 6e 63 65 |].dm<rc2) bounce|
000033a0 28 62 6f 69 64 5b 62 6f 69 64 5b 69 5d 2e 69 6d |(boid[boid[i].im|
000033b0 5d 2e 78 2d 78 2c 20 62 6f 69 64 5b 62 6f 69 64 |].x-x, boid[boid|
000033c0 5b 69 5d 2e 69 6d 5d 2e 79 2d 79 2c 20 26 76 78 |[i].im].y-y, &vx|
000033d0 2c 20 26 76 79 2c 20 62 6f 69 64 5b 69 5d 2e 64 |, &vy, boid[i].d|
000033e0 6d 29 3b 0a 20 20 20 20 20 20 65 6c 73 65 20 7b |m);. else {|
000033f0 0a 20 20 20 20 20 20 20 20 61 20 3d 20 62 6f 69 |. a = boi|
00003400 64 5b 69 5d 2e 61 78 2f 62 6f 69 64 5b 69 5d 2e |d[i].ax/boid[i].|
00003410 61 63 3b 0a 20 20 20 20 20 20 20 20 62 20 3d 20 |ac;. b = |
00003420 62 6f 69 64 5b 69 5d 2e 61 79 2f 62 6f 69 64 5b |boid[i].ay/boid[|
00003430 69 5d 2e 61 63 3b 0a 20 20 20 20 20 20 20 20 64 |i].ac;. d|
00003440 20 3d 20 6d 61 67 6e 69 74 75 64 65 28 61 2c 62 | = magnitude(a,b|
00003450 29 3b 0a 20 20 20 20 20 20 20 20 61 20 3d 20 64 |);. a = d|
00003460 69 76 5f 66 72 61 63 31 36 28 61 2c 64 29 3b 0a |iv_frac16(a,d);.|
00003470 20 20 20 20 20 20 20 20 62 20 3d 20 64 69 76 5f | b = div_|
00003480 66 72 61 63 31 36 28 62 2c 64 29 3b 0a 20 20 20 |frac16(b,d);. |
00003490 20 20 20 20 20 64 20 3d 20 6e 65 61 72 65 73 74 | d = nearest|
000034a0 73 5f 73 71 72 74 28 69 29 3b 0a 20 20 20 20 20 |s_sqrt(i);. |
000034b0 20 20 20 69 66 20 28 64 3c 72 6d 29 20 7b 0a 20 | if (d<rm) {. |
000034c0 20 20 20 20 20 20 20 20 20 76 78 20 3d 20 64 69 | vx = di|
000034d0 76 5f 66 72 61 63 31 36 28 20 6d 75 6c 5f 66 72 |v_frac16( mul_fr|
000034e0 61 63 31 36 28 62 6f 69 64 5b 69 5d 2e 61 76 78 |ac16(boid[i].avx|
000034f0 2f 62 6f 69 64 5b 69 5d 2e 61 63 2c 20 72 6d 2d |/boid[i].ac, rm-|
00003500 64 29 2b 6d 75 6c 5f 66 72 61 63 31 36 28 64 2d |d)+mul_frac16(d-|
00003510 72 63 2c 20 61 2a 67 29 20 2c 20 72 6d 2d 72 63 |rc, a*g) , rm-rc|
00003520 20 29 3b 0a 20 20 20 20 20 20 20 20 20 20 76 79 | );. vy|
00003530 20 3d 20 64 69 76 5f 66 72 61 63 31 36 28 20 6d | = div_frac16( m|
00003540 75 6c 5f 66 72 61 63 31 36 28 62 6f 69 64 5b 69 |ul_frac16(boid[i|
00003550 5d 2e 61 76 79 2f 62 6f 69 64 5b 69 5d 2e 61 63 |].avy/boid[i].ac|
00003560 2c 20 72 6d 2d 64 29 2b 6d 75 6c 5f 66 72 61 63 |, rm-d)+mul_frac|
00003570 31 36 28 64 2d 72 63 2c 20 62 2a 67 29 20 2c 20 |16(d-rc, b*g) , |
00003580 72 6d 2d 72 63 20 29 3b 0a 20 20 20 20 20 20 20 |rm-rc );. |
00003590 20 7d 0a 20 20 20 20 20 20 20 20 65 6c 73 65 20 | }. else |
000035a0 7b 0a 20 20 20 20 20 20 20 20 20 20 64 20 20 3d |{. d =|
000035b0 20 64 69 76 5f 66 72 61 63 31 36 28 64 2c 20 72 | div_frac16(d, r|
000035c0 6d 29 3b 0a 20 20 20 20 20 20 20 20 20 20 69 66 |m);. if|
000035d0 20 28 64 3e 31 36 2a 6f 6e 65 29 20 64 3d 31 36 | (d>16*one) d=16|
000035e0 2a 6f 6e 65 3b 09 2f 2a 70 72 65 76 65 6e 74 20 |*one;./*prevent |
000035f0 72 69 64 69 63 75 6c 6f 75 73 6c 79 20 68 69 67 |ridiculously hig|
00003600 68 20 63 61 74 63 68 20 75 70 20 73 70 65 65 64 |h catch up speed|
00003610 73 2a 2f 0a 20 20 20 20 20 20 20 20 20 20 76 78 |s*/. vx|
00003620 20 3d 20 6d 75 6c 5f 66 72 61 63 31 36 28 64 2c | = mul_frac16(d,|
00003630 20 61 2a 67 29 3b 0a 20 20 20 20 20 20 20 20 20 | a*g);. |
00003640 20 76 79 20 3d 20 6d 75 6c 5f 66 72 61 63 31 36 | vy = mul_frac16|
00003650 28 64 2c 20 62 2a 67 29 3b 0a 20 20 20 20 20 20 |(d, b*g);. |
00003660 20 20 7d 0a 20 20 20 20 20 20 7d 0a 20 20 20 20 | }. }. |
00003670 7d 0a 20 20 20 20 64 20 3d 20 6d 61 67 6e 69 74 |}. d = magnit|
00003680 75 64 65 28 76 78 2c 76 79 29 3b 0a 20 20 20 20 |ude(vx,vy);. |
00003690 69 66 20 28 64 3c 67 2a 6f 6e 65 29 20 7b 0a 20 |if (d<g*one) {. |
000036a0 20 20 20 20 20 76 78 20 3d 20 64 69 76 5f 66 72 | vx = div_fr|
000036b0 61 63 31 36 28 76 78 2a 67 2c 64 29 3b 0a 20 20 |ac16(vx*g,d);. |
000036c0 20 20 20 20 76 79 20 3d 20 64 69 76 5f 66 72 61 | vy = div_fra|
000036d0 63 31 36 28 76 79 2a 67 2c 64 29 3b 0a 20 20 20 |c16(vy*g,d);. |
000036e0 20 20 20 64 20 20 3d 20 67 2a 6f 6e 65 3b 0a 20 | d = g*one;. |
000036f0 20 20 20 7d 0a 20 20 20 20 62 6f 69 64 5b 69 5d | }. boid[i]|
00003700 2e 78 6e 20 3d 20 62 6f 69 64 5b 69 5d 2e 78 2b |.xn = boid[i].x+|
00003710 76 78 3b 0a 20 20 20 20 62 6f 69 64 5b 69 5d 2e |vx;. boid[i].|
00003720 79 6e 20 3d 20 62 6f 69 64 5b 69 5d 2e 79 2b 76 |yn = boid[i].y+v|
00003730 79 3b 0a 20 20 20 20 62 6f 69 64 5b 69 5d 2e 76 |y;. boid[i].v|
00003740 78 20 3d 20 76 78 3b 0a 20 20 20 20 62 6f 69 64 |x = vx;. boid|
00003750 5b 69 5d 2e 76 79 20 3d 20 76 79 3b 0a 20 20 20 |[i].vy = vy;. |
00003760 20 62 6f 69 64 5b 69 5d 2e 6d 76 20 3d 20 64 3b | boid[i].mv = d;|
00003770 0a 20 20 7d 0a 20 20 66 6f 72 20 28 69 3d 30 3b |. }. for (i=0;|
00003780 20 69 3c 6e 3b 20 69 2b 2b 29 20 7b 0a 20 20 20 | i<n; i++) {. |
00003790 20 62 6f 69 64 5b 69 5d 2e 78 20 3d 20 62 6f 69 | boid[i].x = boi|
000037a0 64 5b 69 5d 2e 78 6e 3b 0a 20 20 20 20 62 6f 69 |d[i].xn;. boi|
000037b0 64 5b 69 5d 2e 79 20 3d 20 62 6f 69 64 5b 69 5d |d[i].y = boid[i]|
000037c0 2e 79 6e 3b 0a 20 20 7d 0a 7d 0a 0a 69 6e 74 20 |.yn;. }.}..int |
000037d0 6d 61 69 6e 28 76 6f 69 64 29 0a 7b 0a 20 20 69 |main(void).{. i|
000037e0 6e 74 20 69 3b 0a 20 20 69 66 20 28 21 69 6e 69 |nt i;. if (!ini|
000037f0 74 28 29 29 20 72 65 74 75 72 6e 20 30 3b 0a 20 |t()) return 0;. |
00003800 20 66 6f 72 20 28 73 69 6e 67 6c 65 5f 73 74 65 | for (single_ste|
00003810 70 3d 46 41 4c 53 45 3b 3b 29 20 7b 0a 20 20 20 |p=FALSE;;) {. |
00003820 20 74 74 6f 74 61 6c 3d 63 6c 6f 63 6b 28 29 3b | ttotal=clock();|
00003830 0a 20 20 20 20 62 62 63 5f 63 6c 73 28 29 3b 0a |. bbc_cls();.|
00003840 20 20 20 20 6d 6f 76 65 5f 62 6f 69 64 73 28 29 | move_boids()|
00003850 3b 0a 20 20 20 20 63 68 65 63 6b 5f 6d 6f 75 73 |;. check_mous|
00003860 65 28 29 3b 0a 20 20 20 20 66 6f 72 20 28 69 3d |e();. for (i=|
00003870 30 3b 20 69 3c 6e 3b 20 69 2b 2b 29 20 7b 0a 20 |0; i<n; i++) {. |
00003880 20 20 20 20 20 62 62 63 5f 6d 6f 76 65 28 62 6f | bbc_move(bo|
00003890 69 64 5b 69 5d 2e 78 2f 6f 6e 65 2c 20 62 6f 69 |id[i].x/one, boi|
000038a0 64 5b 69 5d 2e 79 2f 6f 6e 65 29 3b 0a 20 20 20 |d[i].y/one);. |
000038b0 20 20 20 62 62 63 5f 64 72 61 77 62 79 28 28 62 | bbc_drawby((b|
000038c0 6f 69 64 5b 69 5d 2e 76 78 2a 32 2a 67 29 2f 62 |oid[i].vx*2*g)/b|
000038d0 6f 69 64 5b 69 5d 2e 6d 76 2c 20 28 62 6f 69 64 |oid[i].mv, (boid|
000038e0 5b 69 5d 2e 76 79 2a 32 2a 67 29 2f 62 6f 69 64 |[i].vy*2*g)/boid|
000038f0 5b 69 5d 2e 6d 76 29 3b 0a 20 20 20 20 7d 0a 20 |[i].mv);. }. |
00003900 20 20 20 66 6f 72 20 28 69 3d 30 3b 20 69 3c 70 | for (i=0; i<p|
00003910 6e 3b 20 69 2b 2b 29 20 62 62 63 5f 63 69 72 63 |n; i++) bbc_circ|
00003920 6c 65 28 70 69 6c 6c 61 72 5b 69 5d 2e 78 2f 6f |le(pillar[i].x/o|
00003930 6e 65 2c 20 70 69 6c 6c 61 72 5b 69 5d 2e 79 2f |ne, pillar[i].y/|
00003940 6f 6e 65 2c 20 70 69 6c 6c 61 72 5b 69 5d 2e 72 |one, pillar[i].r|
00003950 2f 6f 6e 65 29 3b 0a 20 20 20 20 74 74 6f 74 61 |/one);. ttota|
00003960 6c 3d 63 6c 6f 63 6b 28 29 2d 74 74 6f 74 61 6c |l=clock()-ttotal|
00003970 3b 0a 20 20 20 20 70 72 69 6e 74 66 28 22 25 69 |;. printf("%i|
00003980 5c 6e 25 69 5c 6e 22 2c 74 6e 32 2c 74 74 6f 74 |\n%i\n",tn2,ttot|
00003990 61 6c 29 3b 0a 20 20 20 20 6f 73 5f 73 77 69 31 |al);. os_swi1|
000039a0 28 4f 53 5f 42 79 74 65 2c 20 31 39 29 3b 0a 20 |(OS_Byte, 19);. |
000039b0 20 20 20 73 77 61 70 5f 62 61 6e 6b 73 28 29 3b | swap_banks();|
000039c0 0a 20 20 20 20 73 74 65 70 28 29 3b 0a 20 20 20 |. step();. |
000039d0 20 69 66 20 28 6b 62 68 69 74 28 29 29 0a 20 20 | if (kbhit()). |
000039e0 20 20 20 20 69 66 20 28 21 69 6e 69 74 28 29 29 | if (!init())|
000039f0 20 62 72 65 61 6b 3b 0a 20 20 7d 0a 20 20 72 65 | break;. }. re|
00003a00 74 75 72 6e 20 30 3b 0a 7d 0a |turn 0;.}.|
00003a0a 
.