Home » Archimedes archive » Archimedes World » archimedes_world_volume_15_issue_4_scp.adf » AcornAns » Flocking/~Old/c/QuickPureC
Flocking/~Old/c/QuickPureC
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/~Old/c/QuickPureC |
| Read OK: | ✔ |
| File size: | 4050 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;
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_y(boid_data *a, boid_data *b)
{
boid_data *c;
c = &zlow;
do {
if (a->y < b->y) {
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(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_y(sort_y(a, n/2), sort_y(b, n-n/2));
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)
if (square1610(b->x-middle)<a->dm) {
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)
if (square1610(b->x-middle)<a->dm) {
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 *merge_x(boid_data *a, boid_data *b)
{
boid_data *c;
c = &zlow;
do {
if (a->x < b->x) {
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_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_x(sort_x(a, n/2), sort_x(b, n-n/2));
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;
/* int rx, ry;*/
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();
/*
for (i=0; i<n-1; i++)
for (j=i+1; j<n; j++) {
a = (rx=boid[i].x-boid[j].x)/one;
a = a*a;
if (a<rl2/1024) {
b = (ry=boid[i].y-boid[j].y)/one;
a += b*b;
if (a<rl2/1024) {
d = mul1610(rx,rx) + mul1610(ry,ry);
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;
}
}
}
}
*/
/*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;
}
}
}
}
}
/*
for (i=0; i<n-1; i++)
for (j=i+1; j<n; j++) {
a = (rx=boid[i].x-boid[j].x)/one;
a = a*a;
if (a<boid[i].dm/1024 || a<boid[j].dm/1024) {
b = (ry=boid[i].y-boid[j].y)/one;
a += b*b;
if (a<boid[i].dm/1024 || a<boid[j].dm/1024) {
d = mul1610(rx,rx) + mul1610(ry,ry);
if (d<boid[i].dm) {
boid[i].dm = d;
boid[i].im = j;
}
if (d<boid[j].dm) {
boid[j].dm = d;
boid[j].im = i;
}
}
}
}
*/
/*minimum distance calculation*/
h = sort_x(h, n);
h = sort_y(h, n);
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 0a 20 20 67 72 6c 20 20 20 |lgsize;. grl |
000016d0 3d 20 28 72 6c 2f 6f 6e 65 29 2f 67 73 69 7a 65 |= (rl/one)/gsize|
000016e0 20 2b 20 31 3b 0a 20 20 6d 61 78 67 78 20 3d 20 | + 1;. maxgx = |
000016f0 31 2b 31 32 38 30 2f 67 73 69 7a 65 3b 0a 20 20 |1+1280/gsize;. |
00001700 6d 61 78 67 79 20 3d 20 31 2b 31 30 32 34 2f 67 |maxgy = 1+1024/g|
00001710 73 69 7a 65 3b 0a 20 20 69 66 20 28 67 6d 61 73 |size;. if (gmas|
00001720 6b 20 3d 20 63 61 6c 6c 6f 63 28 28 67 72 6c 2b |k = calloc((grl+|
00001730 31 29 2a 28 67 72 6c 2b 31 29 2c 20 73 69 7a 65 |1)*(grl+1), size|
00001740 6f 66 28 42 4f 4f 4c 29 29 2c 20 67 6d 61 73 6b |of(BOOL)), gmask|
00001750 3d 3d 30 29 20 7b 0a 20 20 20 20 77 65 72 72 28 |==0) {. werr(|
00001760 77 65 72 72 74 65 72 6d 2c 20 22 49 6e 73 75 66 |werrterm, "Insuf|
00001770 66 69 63 69 65 6e 74 20 6d 65 6d 6f 72 79 22 29 |ficient memory")|
00001780 3b 0a 20 20 20 20 72 65 74 75 72 6e 20 46 41 4c |;. return FAL|
00001790 53 45 3b 0a 20 20 7d 0a 20 20 66 6f 72 20 28 6a |SE;. }. for (j|
000017a0 3d 30 3b 20 6a 3c 3d 67 72 6c 3b 20 6a 2b 2b 29 |=0; j<=grl; j++)|
000017b0 0a 20 20 20 20 66 6f 72 20 28 69 3d 30 3b 20 69 |. for (i=0; i|
000017c0 3c 3d 67 72 6c 3b 20 69 2b 2b 29 0a 20 20 20 20 |<=grl; i++). |
000017d0 20 20 67 6d 61 73 6b 5b 69 2b 28 67 72 6c 2b 31 | gmask[i+(grl+1|
000017e0 29 2a 6a 5d 20 3d 20 28 20 69 3e 30 20 26 26 20 |)*j] = ( i>0 && |
000017f0 6a 3e 30 20 26 26 20 28 28 69 2d 31 29 2a 28 69 |j>0 && ((i-1)*(i|
00001800 2d 31 29 2b 28 6a 2d 31 29 2a 28 6a 2d 31 29 29 |-1)+(j-1)*(j-1))|
00001810 2a 67 73 69 7a 65 2a 67 73 69 7a 65 3e 28 72 6c |*gsize*gsize>(rl|
00001820 2f 6f 6e 65 29 2a 28 72 6c 2f 6f 6e 65 29 20 29 |/one)*(rl/one) )|
00001830 20 3f 20 46 41 4c 53 45 20 3a 20 54 52 55 45 3b | ? FALSE : TRUE;|
00001840 0a 20 20 69 66 20 28 67 72 69 64 20 3d 20 63 61 |. if (grid = ca|
00001850 6c 6c 6f 63 28 28 6d 61 78 67 78 2b 31 29 2a 28 |lloc((maxgx+1)*(|
00001860 6d 61 78 67 79 2b 31 29 2c 20 73 69 7a 65 6f 66 |maxgy+1), sizeof|
00001870 28 67 6e 6f 64 65 20 2a 29 29 2c 20 67 72 69 64 |(gnode *)), grid|
00001880 3d 3d 30 29 20 7b 0a 20 20 20 20 77 65 72 72 28 |==0) {. werr(|
00001890 77 65 72 72 74 65 72 6d 2c 20 22 49 6e 73 75 66 |werrterm, "Insuf|
000018a0 66 69 63 69 65 6e 74 20 6d 65 6d 6f 72 79 22 29 |ficient memory")|
000018b0 3b 0a 20 20 20 20 72 65 74 75 72 6e 20 46 41 4c |;. return FAL|
000018c0 53 45 3b 0a 20 20 7d 0a 20 20 69 66 20 28 62 6f |SE;. }. if (bo|
000018d0 69 64 67 6e 6f 64 65 20 3d 20 63 61 6c 6c 6f 63 |idgnode = calloc|
000018e0 28 20 6e 2c 20 73 69 7a 65 6f 66 28 67 6e 6f 64 |( n, sizeof(gnod|
000018f0 65 29 29 2c 20 62 6f 69 64 67 6e 6f 64 65 3d 3d |e)), boidgnode==|
00001900 30 29 20 7b 0a 20 20 20 20 77 65 72 72 28 77 65 |0) {. werr(we|
00001910 72 72 74 65 72 6d 2c 20 22 49 6e 73 75 66 66 69 |rrterm, "Insuffi|
00001920 63 69 65 6e 74 20 6d 65 6d 6f 72 79 22 29 3b 0a |cient memory");.|
00001930 20 20 20 20 72 65 74 75 72 6e 20 46 41 4c 53 45 | return FALSE|
00001940 3b 0a 20 20 7d 0a 20 20 6d 63 3d 30 3b 0a 20 20 |;. }. mc=0;. |
00001950 66 6f 72 20 28 69 3d 30 3b 20 69 3c 70 6e 3b 20 |for (i=0; i<pn; |
00001960 69 2b 2b 29 20 7b 0a 20 20 20 20 70 69 6c 6c 61 |i++) {. pilla|
00001970 72 5b 69 5d 2e 78 20 20 3d 20 72 61 6e 64 31 36 |r[i].x = rand16|
00001980 28 29 2a 36 34 30 3b 0a 20 20 20 20 70 69 6c 6c |()*640;. pill|
00001990 61 72 5b 69 5d 2e 79 20 20 3d 20 72 61 6e 64 31 |ar[i].y = rand1|
000019a0 36 28 29 2a 35 31 32 3b 0a 20 20 20 20 70 69 6c |6()*512;. pil|
000019b0 6c 61 72 5b 69 5d 2e 72 20 20 3d 20 72 61 6e 64 |lar[i].r = rand|
000019c0 75 31 36 28 29 2a 34 30 3b 0a 20 20 20 20 70 69 |u16()*40;. pi|
000019d0 6c 6c 61 72 5b 69 5d 2e 72 32 20 3d 20 6d 75 6c |llar[i].r2 = mul|
000019e0 31 36 31 30 28 70 69 6c 6c 61 72 5b 69 5d 2e 72 |1610(pillar[i].r|
000019f0 2b 72 63 2f 32 2c 20 70 69 6c 6c 61 72 5b 69 5d |+rc/2, pillar[i]|
00001a00 2e 72 2b 72 63 2f 32 29 3b 0a 20 20 7d 0a 20 20 |.r+rc/2);. }. |
00001a10 66 6f 72 20 28 69 3d 30 3b 20 69 3c 6e 3b 20 69 |for (i=0; i<n; i|
00001a20 2b 2b 29 20 7b 0a 20 20 20 20 62 6f 69 64 5b 69 |++) {. boid[i|
00001a30 5d 2e 78 20 20 3d 20 36 34 2a 67 2a 72 61 6e 64 |].x = 64*g*rand|
00001a40 31 36 28 29 3b 0a 20 20 20 20 62 6f 69 64 5b 69 |16();. boid[i|
00001a50 5d 2e 79 20 20 3d 20 36 34 2a 67 2a 72 61 6e 64 |].y = 64*g*rand|
00001a60 31 36 28 29 3b 0a 20 20 20 20 62 6f 69 64 5b 69 |16();. boid[i|
00001a70 5d 2e 76 78 20 3d 20 20 34 2a 67 2a 72 61 6e 64 |].vx = 4*g*rand|
00001a80 75 31 36 28 29 3b 0a 20 20 20 20 62 6f 69 64 5b |u16();. boid[|
00001a90 69 5d 2e 76 79 20 3d 20 20 32 2a 67 2a 72 61 6e |i].vy = 2*g*ran|
00001aa0 64 31 36 28 29 3b 0a 20 20 20 20 62 6f 69 64 5b |d16();. boid[|
00001ab0 69 5d 2e 6d 76 20 3d 20 6d 61 67 6e 69 74 75 64 |i].mv = magnitud|
00001ac0 65 28 62 6f 69 64 5b 69 5d 2e 76 78 2c 62 6f 69 |e(boid[i].vx,boi|
00001ad0 64 5b 69 5d 2e 76 79 29 3b 0a 20 20 20 20 62 6f |d[i].vy);. bo|
00001ae0 69 64 5b 69 5d 2e 70 72 65 76 69 6f 75 73 20 3d |id[i].previous =|
00001af0 20 62 6f 69 64 2b 69 2d 31 3b 09 2f 2a 73 69 6e | boid+i-1;./*sin|
00001b00 63 65 20 69 6e 69 74 69 61 6c 6c 79 20 62 6f 69 |ce initially boi|
00001b10 64 73 20 61 72 65 20 6c 69 6e 6b 65 64 20 69 6e |ds are linked in|
00001b20 20 6d 65 6d 6f 72 79 20 6f 72 64 65 72 2a 2f 0a | memory order*/.|
00001b30 20 20 20 20 62 6f 69 64 5b 69 5d 2e 6e 65 78 74 | boid[i].next|
00001b40 20 20 20 20 20 3d 20 62 6f 69 64 2b 69 2b 31 3b | = boid+i+1;|
00001b50 0a 20 20 7d 0a 20 20 68 09 09 09 3d 20 62 6f 69 |. }. h...= boi|
00001b60 64 3b 0a 20 20 62 6f 69 64 5b 30 5d 2e 70 72 65 |d;. boid[0].pre|
00001b70 76 69 6f 75 73 09 3d 20 26 7a 6c 6f 77 3b 0a 20 |vious.= &zlow;. |
00001b80 20 62 6f 69 64 5b 6e 2d 31 5d 2e 6e 65 78 74 09 | boid[n-1].next.|
00001b90 3d 20 26 7a 68 69 67 68 3b 0a 20 20 7a 6c 6f 77 |= &zhigh;. zlow|
00001ba0 2e 70 72 65 76 69 6f 75 73 09 09 3d 20 7a 6c 6f |.previous..= zlo|
00001bb0 77 2e 6e 65 78 74 09 3d 20 26 7a 6c 6f 77 3b 0a |w.next.= &zlow;.|
00001bc0 20 20 7a 68 69 67 68 2e 70 72 65 76 69 6f 75 73 | zhigh.previous|
00001bd0 09 3d 20 7a 68 69 67 68 2e 6e 65 78 74 09 3d 20 |.= zhigh.next.= |
00001be0 26 7a 68 69 67 68 3b 0a 20 20 7a 6c 6f 77 2e 78 |&zhigh;. zlow.x|
00001bf0 09 09 3d 20 7a 6c 6f 77 2e 79 09 3d 20 2d 36 34 |..= zlow.y.= -64|
00001c00 30 2a 6f 6e 65 3b 09 2f 2a 73 6d 61 6c 6c 65 73 |0*one;./*smalles|
00001c10 74 20 6e 75 6d 62 65 72 2a 2f 0a 20 20 7a 68 69 |t number*/. zhi|
00001c20 67 68 2e 78 09 09 3d 20 7a 68 69 67 68 2e 79 09 |gh.x..= zhigh.y.|
00001c30 3d 20 20 36 34 30 2a 6f 6e 65 3b 09 2f 2a 62 69 |= 640*one;./*bi|
00001c40 67 67 65 73 74 20 6e 75 6d 62 65 72 2a 2f 0a 20 |ggest number*/. |
00001c50 20 70 72 65 70 61 72 65 5f 73 63 72 65 65 6e 28 | prepare_screen(|
00001c60 29 3b 0a 20 20 72 65 74 75 72 6e 20 54 52 55 45 |);. return TRUE|
00001c70 3b 0a 7d 0a 0a 76 6f 69 64 20 63 68 65 63 6b 5f |;.}..void check_|
00001c80 6d 6f 75 73 65 28 76 6f 69 64 29 0a 7b 0a 20 20 |mouse(void).{. |
00001c90 69 6e 74 20 78 2c 79 2c 7a 2c 20 69 2c 64 3b 0a |int x,y,z, i,d;.|
00001ca0 20 20 6f 73 5f 73 77 69 33 72 28 4f 53 5f 4d 6f | os_swi3r(OS_Mo|
00001cb0 75 73 65 2c 20 30 2c 30 2c 30 2c 20 26 78 2c 26 |use, 0,0,0, &x,&|
00001cc0 79 2c 26 7a 29 3b 0a 20 20 78 2a 3d 6f 6e 65 3b |y,&z);. x*=one;|
00001cd0 0a 20 20 79 2a 3d 6f 6e 65 3b 0a 20 20 73 77 69 |. y*=one;. swi|
00001ce0 74 63 68 28 7a 29 20 7b 0a 20 20 20 20 63 61 73 |tch(z) {. cas|
00001cf0 65 20 31 3a 0a 20 20 20 20 20 20 69 66 20 28 70 |e 1:. if (p|
00001d00 69 6c 6c 61 72 5b 6d 63 5d 2e 72 3e 6f 6e 65 29 |illar[mc].r>one)|
00001d10 20 7b 0a 20 20 20 20 20 20 20 20 70 69 6c 6c 61 | {. pilla|
00001d20 72 5b 6d 63 5d 2e 72 2d 3d 6f 6e 65 3b 0a 20 20 |r[mc].r-=one;. |
00001d30 20 20 20 20 20 20 70 69 6c 6c 61 72 5b 6d 63 5d | pillar[mc]|
00001d40 2e 72 32 3d 6d 75 6c 31 36 31 30 28 70 69 6c 6c |.r2=mul1610(pill|
00001d50 61 72 5b 6d 63 5d 2e 72 2b 72 63 2f 32 2c 20 70 |ar[mc].r+rc/2, p|
00001d60 69 6c 6c 61 72 5b 6d 63 5d 2e 72 2b 72 63 2f 32 |illar[mc].r+rc/2|
00001d70 29 3b 0a 20 20 20 20 20 20 7d 0a 20 20 20 20 20 |);. }. |
00001d80 20 62 72 65 61 6b 3b 0a 20 20 20 20 63 61 73 65 | break;. case|
00001d90 20 32 3a 0a 20 20 20 20 20 20 69 66 20 28 70 69 | 2:. if (pi|
00001da0 6c 6c 61 72 5b 6d 63 5d 2e 72 3c 6f 6e 65 2a 32 |llar[mc].r<one*2|
00001db0 30 30 29 20 7b 0a 20 20 20 20 20 20 20 20 70 69 |00) {. pi|
00001dc0 6c 6c 61 72 5b 6d 63 5d 2e 72 2b 3d 6f 6e 65 3b |llar[mc].r+=one;|
00001dd0 0a 20 20 20 20 20 20 20 20 70 69 6c 6c 61 72 5b |. pillar[|
00001de0 6d 63 5d 2e 72 32 3d 6d 75 6c 31 36 31 30 28 70 |mc].r2=mul1610(p|
00001df0 69 6c 6c 61 72 5b 6d 63 5d 2e 72 2b 72 63 2f 32 |illar[mc].r+rc/2|
00001e00 2c 20 70 69 6c 6c 61 72 5b 6d 63 5d 2e 72 2b 72 |, pillar[mc].r+r|
00001e10 63 2f 32 29 3b 0a 20 20 20 20 20 20 7d 0a 20 20 |c/2);. }. |
00001e20 20 20 20 20 62 72 65 61 6b 3b 0a 20 20 20 20 63 | break;. c|
00001e30 61 73 65 20 34 3a 0a 20 20 20 20 20 20 66 6f 72 |ase 4:. for|
00001e40 20 28 69 3d 6d 63 3b 20 69 3c 70 6e 3b 20 69 2b | (i=mc; i<pn; i+|
00001e50 2b 29 20 7b 0a 20 20 20 20 20 20 20 20 69 66 20 |+) {. if |
00001e60 28 61 62 73 28 70 69 6c 6c 61 72 5b 69 5d 2e 78 |(abs(pillar[i].x|
00001e70 2d 78 29 3c 70 69 6c 6c 61 72 5b 69 5d 2e 72 20 |-x)<pillar[i].r |
00001e80 26 26 20 61 62 73 28 70 69 6c 6c 61 72 5b 69 5d |&& abs(pillar[i]|
00001e90 2e 79 2d 79 29 3c 70 69 6c 6c 61 72 5b 69 5d 2e |.y-y)<pillar[i].|
00001ea0 72 29 20 7b 0a 20 20 20 20 20 20 20 20 20 20 64 |r) {. d|
00001eb0 20 3d 20 6d 75 6c 31 36 31 30 28 70 69 6c 6c 61 | = mul1610(pilla|
00001ec0 72 5b 69 5d 2e 78 2d 78 2c 70 69 6c 6c 61 72 5b |r[i].x-x,pillar[|
00001ed0 69 5d 2e 78 2d 78 29 20 2b 20 6d 75 6c 31 36 31 |i].x-x) + mul161|
00001ee0 30 28 70 69 6c 6c 61 72 5b 69 5d 2e 79 2d 79 2c |0(pillar[i].y-y,|
00001ef0 70 69 6c 6c 61 72 5b 69 5d 2e 79 2d 79 29 3b 0a |pillar[i].y-y);.|
00001f00 20 20 20 20 20 20 20 20 20 20 69 66 20 28 64 20 | if (d |
00001f10 3c 20 70 69 6c 6c 61 72 5b 69 5d 2e 72 32 29 20 |< pillar[i].r2) |
00001f20 7b 0a 20 20 20 20 20 20 20 20 20 20 20 20 69 2b |{. i+|
00001f30 3d 30 78 31 30 30 30 30 3b 0a 20 20 20 20 20 20 |=0x10000;. |
00001f40 20 20 20 20 20 20 62 72 65 61 6b 3b 0a 20 20 20 | break;. |
00001f50 20 20 20 20 20 20 20 7d 0a 20 20 20 20 20 20 20 | }. |
00001f60 20 7d 0a 20 20 20 20 20 20 20 20 69 66 20 28 69 | }. if (i|
00001f70 3d 3d 6d 63 29 20 20 20 69 3d 2d 31 3b 0a 20 20 |==mc) i=-1;. |
00001f80 20 20 20 20 20 20 69 66 20 28 69 3d 3d 6d 63 2d | if (i==mc-|
00001f90 31 29 20 69 3d 6d 63 3b 0a 20 20 20 20 20 20 7d |1) i=mc;. }|
00001fa0 0a 20 20 20 20 20 20 69 66 20 28 69 26 30 78 31 |. if (i&0x1|
00001fb0 30 30 30 30 20 26 26 20 69 21 3d 30 78 31 30 30 |0000 && i!=0x100|
00001fc0 30 30 2b 6d 63 29 20 7b 0a 20 20 20 20 20 20 20 |00+mc) {. |
00001fd0 20 6d 63 20 3d 20 69 2d 30 78 31 30 30 30 30 3b | mc = i-0x10000;|
00001fe0 0a 20 20 20 20 20 20 20 20 62 62 63 5f 76 64 75 |. bbc_vdu|
00001ff0 28 37 29 3b 0a 20 20 20 20 20 20 7d 0a 20 20 20 |(7);. }. |
00002000 20 20 20 65 6c 73 65 20 7b 0a 20 20 20 20 20 20 | else {. |
00002010 20 20 70 69 6c 6c 61 72 5b 6d 63 5d 2e 78 20 3d | pillar[mc].x =|
00002020 20 78 3b 0a 20 20 20 20 20 20 20 20 70 69 6c 6c | x;. pill|
00002030 61 72 5b 6d 63 5d 2e 79 20 3d 20 79 3b 0a 20 20 |ar[mc].y = y;. |
00002040 20 20 20 20 7d 0a 20 20 20 20 20 20 62 72 65 61 | }. brea|
00002050 6b 3b 0a 20 20 7d 0a 7d 0a 0a 62 6f 69 64 5f 64 |k;. }.}..boid_d|
00002060 61 74 61 20 2a 6d 65 72 67 65 5f 79 28 62 6f 69 |ata *merge_y(boi|
00002070 64 5f 64 61 74 61 20 2a 61 2c 20 62 6f 69 64 5f |d_data *a, boid_|
00002080 64 61 74 61 20 2a 62 29 0a 7b 0a 20 20 62 6f 69 |data *b).{. boi|
00002090 64 5f 64 61 74 61 20 2a 63 3b 0a 20 20 63 20 3d |d_data *c;. c =|
000020a0 20 26 7a 6c 6f 77 3b 0a 20 20 64 6f 20 7b 0a 20 | &zlow;. do {. |
000020b0 20 20 20 69 66 20 28 61 2d 3e 79 20 3c 20 62 2d | if (a->y < b-|
000020c0 3e 79 29 20 7b 0a 20 20 20 20 20 20 63 2d 3e 6e |>y) {. c->n|
000020d0 65 78 74 20 3d 20 61 3b 0a 20 20 20 20 20 20 61 |ext = a;. a|
000020e0 2d 3e 70 72 65 76 69 6f 75 73 20 3d 20 63 3b 0a |->previous = c;.|
000020f0 20 20 20 20 20 20 63 20 3d 20 61 3b 0a 20 20 20 | c = a;. |
00002100 20 20 20 61 20 3d 20 61 2d 3e 6e 65 78 74 3b 0a | a = a->next;.|
00002110 20 20 20 20 7d 0a 20 20 20 20 65 6c 73 65 20 7b | }. else {|
00002120 0a 20 20 20 20 20 20 63 2d 3e 6e 65 78 74 20 3d |. c->next =|
00002130 20 62 3b 0a 20 20 20 20 20 20 62 2d 3e 70 72 65 | b;. b->pre|
00002140 76 69 6f 75 73 20 3d 20 63 3b 0a 20 20 20 20 20 |vious = c;. |
00002150 20 63 20 3d 20 62 3b 0a 20 20 20 20 20 20 62 20 | c = b;. b |
00002160 3d 20 62 2d 3e 6e 65 78 74 3b 0a 20 20 20 20 7d |= b->next;. }|
00002170 0a 20 20 7d 20 77 68 69 6c 65 20 28 63 20 21 3d |. } while (c !=|
00002180 20 26 7a 68 69 67 68 29 3b 0a 20 20 63 20 3d 20 | &zhigh);. c = |
00002190 7a 6c 6f 77 2e 6e 65 78 74 3b 0a 20 20 7a 6c 6f |zlow.next;. zlo|
000021a0 77 2e 6e 65 78 74 20 3d 20 26 7a 6c 6f 77 3b 0a |w.next = &zlow;.|
000021b0 20 20 7a 68 69 67 68 2e 70 72 65 76 69 6f 75 73 | zhigh.previous|
000021c0 20 3d 20 26 7a 68 69 67 68 3b 0a 20 20 72 65 74 | = &zhigh;. ret|
000021d0 75 72 6e 20 63 3b 0a 7d 0a 0a 62 6f 69 64 5f 64 |urn c;.}..boid_d|
000021e0 61 74 61 20 2a 73 6f 72 74 5f 79 28 62 6f 69 64 |ata *sort_y(boid|
000021f0 5f 64 61 74 61 20 2a 63 2c 20 69 6e 74 20 6e 29 |_data *c, int n)|
00002200 0a 7b 0a 20 20 69 6e 74 20 6d 69 64 64 6c 65 3b |.{. int middle;|
00002210 0a 20 20 62 6f 69 64 5f 64 61 74 61 20 2a 61 2c |. boid_data *a,|
00002220 20 2a 62 3b 0a 20 20 73 74 61 74 69 63 20 69 6e | *b;. static in|
00002230 74 20 69 2c 20 64 3b 0a 20 20 73 74 61 74 69 63 |t i, d;. static|
00002240 20 42 4f 4f 4c 20 6c 65 66 74 3b 20 20 0a 20 20 | BOOL left; . |
00002250 69 66 20 28 63 2d 3e 6e 65 78 74 3d 3d 26 7a 68 |if (c->next==&zh|
00002260 69 67 68 29 20 72 65 74 75 72 6e 20 63 3b 0a 20 |igh) return c;. |
00002270 20 61 20 3d 20 63 3b 0a 20 20 66 6f 72 20 28 69 | a = c;. for (i|
00002280 3d 32 3b 20 69 3c 3d 6e 2f 32 3b 20 69 2b 2b 29 |=2; i<=n/2; i++)|
00002290 20 63 3d 63 2d 3e 6e 65 78 74 3b 0a 20 20 62 20 | c=c->next;. b |
000022a0 3d 20 63 2d 3e 6e 65 78 74 3b 0a 20 20 63 2d 3e |= c->next;. c->|
000022b0 6e 65 78 74 20 3d 20 26 7a 68 69 67 68 3b 0a 20 |next = &zhigh;. |
000022c0 20 62 2d 3e 70 72 65 76 69 6f 75 73 20 3d 20 26 | b->previous = &|
000022d0 7a 6c 6f 77 3b 0a 20 20 6d 69 64 64 6c 65 20 3d |zlow;. middle =|
000022e0 20 62 2d 3e 78 3b 0a 20 20 63 20 3d 20 6d 65 72 | b->x;. c = mer|
000022f0 67 65 5f 79 28 73 6f 72 74 5f 79 28 61 2c 20 6e |ge_y(sort_y(a, n|
00002300 2f 32 29 2c 20 73 6f 72 74 5f 79 28 62 2c 20 6e |/2), sort_y(b, n|
00002310 2d 6e 2f 32 29 29 3b 0a 20 20 66 6f 72 20 28 61 |-n/2));. for (a|
00002320 3d 63 3b 20 61 21 3d 26 7a 68 69 67 68 3b 20 61 |=c; a!=&zhigh; a|
00002330 3d 61 2d 3e 6e 65 78 74 29 20 7b 0a 20 20 20 20 |=a->next) {. |
00002340 69 66 20 28 73 71 75 61 72 65 31 36 31 30 28 61 |if (square1610(a|
00002350 2d 3e 78 2d 6d 69 64 64 6c 65 29 20 3c 20 61 2d |->x-middle) < a-|
00002360 3e 64 6d 29 20 7b 0a 20 20 20 20 20 20 6c 65 66 |>dm) {. lef|
00002370 74 20 3d 20 61 2d 3e 78 3c 6d 69 64 64 6c 65 3b |t = a->x<middle;|
00002380 0a 20 20 20 20 20 20 66 6f 72 20 28 62 3d 61 2d |. for (b=a-|
00002390 3e 6e 65 78 74 3b 20 62 21 3d 26 7a 68 69 67 68 |>next; b!=&zhigh|
000023a0 20 26 26 20 28 64 3d 73 71 75 61 72 65 31 36 31 | && (d=square161|
000023b0 30 28 62 2d 3e 79 2d 61 2d 3e 79 29 29 3c 61 2d |0(b->y-a->y))<a-|
000023c0 3e 64 6d 3b 20 62 3d 62 2d 3e 6e 65 78 74 29 20 |>dm; b=b->next) |
000023d0 7b 0a 20 20 20 20 20 20 20 20 69 66 20 28 6c 65 |{. if (le|
000023e0 66 74 20 26 26 20 62 2d 3e 78 3e 3d 6d 69 64 64 |ft && b->x>=midd|
000023f0 6c 65 20 20 7c 7c 20 20 21 6c 65 66 74 20 26 26 |le || !left &&|
00002400 20 62 2d 3e 78 3c 3d 6d 69 64 64 6c 65 29 0a 20 | b->x<=middle). |
00002410 20 20 20 20 20 20 20 20 20 69 66 20 28 73 71 75 | if (squ|
00002420 61 72 65 31 36 31 30 28 62 2d 3e 78 2d 6d 69 64 |are1610(b->x-mid|
00002430 64 6c 65 29 3c 61 2d 3e 64 6d 29 20 7b 0a 20 20 |dle)<a->dm) {. |
00002440 20 20 20 20 20 20 20 20 20 20 64 2b 3d 73 71 75 | d+=squ|
00002450 61 72 65 31 36 31 30 28 62 2d 3e 78 2d 61 2d 3e |are1610(b->x-a->|
00002460 78 29 3b 0a 20 20 20 20 20 20 20 20 20 20 20 20 |x);. |
00002470 69 66 20 28 64 3c 61 2d 3e 64 6d 29 20 7b 0a 20 |if (d<a->dm) {. |
00002480 20 20 20 20 20 20 20 20 20 20 20 20 20 61 2d 3e | a->|
00002490 64 6d 20 3d 20 64 3b 0a 20 20 20 20 20 20 20 20 |dm = d;. |
000024a0 20 20 20 20 20 20 61 2d 3e 69 6d 20 3d 20 62 2d | a->im = b-|
000024b0 62 6f 69 64 3b 0a 20 20 20 20 20 20 20 20 20 20 |boid;. |
000024c0 20 20 7d 0a 20 20 20 20 20 20 20 20 20 20 20 20 | }. |
000024d0 69 66 20 28 64 3c 62 2d 3e 64 6d 29 20 7b 0a 20 |if (d<b->dm) {. |
000024e0 20 20 20 20 20 20 20 20 20 20 20 20 20 62 2d 3e | b->|
000024f0 64 6d 20 3d 20 64 3b 0a 20 20 20 20 20 20 20 20 |dm = d;. |
00002500 20 20 20 20 20 20 62 2d 3e 69 6d 20 3d 20 61 2d | b->im = a-|
00002510 62 6f 69 64 3b 0a 20 20 20 20 20 20 20 20 20 20 |boid;. |
00002520 20 20 7d 0a 20 20 20 20 20 20 20 20 20 20 7d 0a | }. }.|
00002530 20 20 20 20 20 20 7d 0a 20 20 20 20 20 20 66 6f | }. fo|
00002540 72 20 28 62 3d 61 2d 3e 70 72 65 76 69 6f 75 73 |r (b=a->previous|
00002550 3b 20 62 21 3d 26 7a 6c 6f 77 20 26 26 20 28 64 |; b!=&zlow && (d|
00002560 3d 73 71 75 61 72 65 31 36 31 30 28 62 2d 3e 79 |=square1610(b->y|
00002570 2d 61 2d 3e 79 29 29 3c 61 2d 3e 64 6d 3b 20 62 |-a->y))<a->dm; b|
00002580 3d 62 2d 3e 70 72 65 76 69 6f 75 73 29 20 7b 0a |=b->previous) {.|
00002590 20 20 20 20 20 20 20 20 69 66 20 28 6c 65 66 74 | if (left|
000025a0 20 26 26 20 62 2d 3e 78 3e 3d 6d 69 64 64 6c 65 | && b->x>=middle|
000025b0 20 20 7c 7c 20 20 21 6c 65 66 74 20 26 26 20 62 | || !left && b|
000025c0 2d 3e 78 3c 3d 6d 69 64 64 6c 65 29 0a 20 20 20 |->x<=middle). |
000025d0 20 20 20 20 20 20 20 69 66 20 28 73 71 75 61 72 | if (squar|
000025e0 65 31 36 31 30 28 62 2d 3e 78 2d 6d 69 64 64 6c |e1610(b->x-middl|
000025f0 65 29 3c 61 2d 3e 64 6d 29 20 7b 0a 20 20 20 20 |e)<a->dm) {. |
00002600 20 20 20 20 20 20 20 20 64 2b 3d 73 71 75 61 72 | d+=squar|
00002610 65 31 36 31 30 28 62 2d 3e 78 2d 61 2d 3e 78 29 |e1610(b->x-a->x)|
00002620 3b 0a 20 20 20 20 20 20 20 20 20 20 20 20 69 66 |;. if|
00002630 20 28 64 3c 61 2d 3e 64 6d 29 20 7b 0a 20 20 20 | (d<a->dm) {. |
00002640 20 20 20 20 20 20 20 20 20 20 20 61 2d 3e 64 6d | a->dm|
00002650 20 3d 20 64 3b 0a 20 20 20 20 20 20 20 20 20 20 | = d;. |
00002660 20 20 20 20 61 2d 3e 69 6d 20 3d 20 62 2d 62 6f | a->im = b-bo|
00002670 69 64 3b 0a 20 20 20 20 20 20 20 20 20 20 20 20 |id;. |
00002680 7d 0a 20 20 20 20 20 20 20 20 20 20 20 20 69 66 |}. if|
00002690 20 28 64 3c 62 2d 3e 64 6d 29 20 7b 0a 20 20 20 | (d<b->dm) {. |
000026a0 20 20 20 20 20 20 20 20 20 20 20 62 2d 3e 64 6d | b->dm|
000026b0 20 3d 20 64 3b 0a 20 20 20 20 20 20 20 20 20 20 | = d;. |
000026c0 20 20 20 20 62 2d 3e 69 6d 20 3d 20 61 2d 62 6f | b->im = a-bo|
000026d0 69 64 3b 0a 20 20 20 20 20 20 20 20 20 20 20 20 |id;. |
000026e0 7d 0a 20 20 20 20 20 20 20 20 20 20 7d 0a 20 20 |}. }. |
000026f0 20 20 20 20 7d 0a 20 20 20 20 7d 0a 20 20 7d 0a | }. }. }.|
00002700 20 20 72 65 74 75 72 6e 20 63 3b 0a 7d 0a 0a 62 | return c;.}..b|
00002710 6f 69 64 5f 64 61 74 61 20 2a 6d 65 72 67 65 5f |oid_data *merge_|
00002720 78 28 62 6f 69 64 5f 64 61 74 61 20 2a 61 2c 20 |x(boid_data *a, |
00002730 62 6f 69 64 5f 64 61 74 61 20 2a 62 29 0a 7b 0a |boid_data *b).{.|
00002740 20 20 62 6f 69 64 5f 64 61 74 61 20 2a 63 3b 0a | boid_data *c;.|
00002750 20 20 63 20 3d 20 26 7a 6c 6f 77 3b 0a 20 20 64 | c = &zlow;. d|
00002760 6f 20 7b 0a 20 20 20 20 69 66 20 28 61 2d 3e 78 |o {. if (a->x|
00002770 20 3c 20 62 2d 3e 78 29 20 7b 0a 20 20 20 20 20 | < b->x) {. |
00002780 20 63 2d 3e 6e 65 78 74 20 3d 20 61 3b 0a 20 20 | c->next = a;. |
00002790 20 20 20 20 61 2d 3e 70 72 65 76 69 6f 75 73 20 | a->previous |
000027a0 3d 20 63 3b 0a 20 20 20 20 20 20 63 20 3d 20 61 |= c;. c = a|
000027b0 3b 0a 20 20 20 20 20 20 61 20 3d 20 61 2d 3e 6e |;. a = a->n|
000027c0 65 78 74 3b 0a 20 20 20 20 7d 0a 20 20 20 20 65 |ext;. }. e|
000027d0 6c 73 65 20 7b 0a 20 20 20 20 20 20 63 2d 3e 6e |lse {. c->n|
000027e0 65 78 74 20 3d 20 62 3b 0a 20 20 20 20 20 20 62 |ext = b;. b|
000027f0 2d 3e 70 72 65 76 69 6f 75 73 20 3d 20 63 3b 0a |->previous = c;.|
00002800 20 20 20 20 20 20 63 20 3d 20 62 3b 0a 20 20 20 | c = b;. |
00002810 20 20 20 62 20 3d 20 62 2d 3e 6e 65 78 74 3b 0a | b = b->next;.|
00002820 20 20 20 20 7d 0a 20 20 7d 20 77 68 69 6c 65 20 | }. } while |
00002830 28 63 20 21 3d 20 26 7a 68 69 67 68 29 3b 0a 20 |(c != &zhigh);. |
00002840 20 63 20 3d 20 7a 6c 6f 77 2e 6e 65 78 74 3b 0a | c = zlow.next;.|
00002850 20 20 7a 6c 6f 77 2e 6e 65 78 74 20 3d 20 26 7a | zlow.next = &z|
00002860 6c 6f 77 3b 0a 20 20 7a 68 69 67 68 2e 70 72 65 |low;. zhigh.pre|
00002870 76 69 6f 75 73 20 3d 20 26 7a 68 69 67 68 3b 0a |vious = &zhigh;.|
00002880 20 20 72 65 74 75 72 6e 20 63 3b 0a 7d 0a 0a 62 | return c;.}..b|
00002890 6f 69 64 5f 64 61 74 61 20 2a 73 6f 72 74 5f 78 |oid_data *sort_x|
000028a0 28 62 6f 69 64 5f 64 61 74 61 20 2a 63 2c 20 69 |(boid_data *c, i|
000028b0 6e 74 20 6e 29 0a 7b 0a 20 20 69 6e 74 20 69 3b |nt n).{. int i;|
000028c0 0a 20 20 62 6f 69 64 5f 64 61 74 61 20 2a 61 2c |. boid_data *a,|
000028d0 20 2a 62 3b 0a 20 20 69 66 20 28 63 2d 3e 6e 65 | *b;. if (c->ne|
000028e0 78 74 3d 3d 26 7a 68 69 67 68 29 20 72 65 74 75 |xt==&zhigh) retu|
000028f0 72 6e 20 63 3b 0a 20 20 61 20 3d 20 63 3b 0a 20 |rn c;. a = c;. |
00002900 20 66 6f 72 20 28 69 3d 32 3b 20 69 3c 3d 6e 2f | for (i=2; i<=n/|
00002910 32 3b 20 69 2b 2b 29 20 63 3d 63 2d 3e 6e 65 78 |2; i++) c=c->nex|
00002920 74 3b 0a 20 20 62 20 3d 20 63 2d 3e 6e 65 78 74 |t;. b = c->next|
00002930 3b 0a 20 20 63 2d 3e 6e 65 78 74 20 3d 20 26 7a |;. c->next = &z|
00002940 68 69 67 68 3b 0a 20 20 62 2d 3e 70 72 65 76 69 |high;. b->previ|
00002950 6f 75 73 20 3d 20 26 7a 6c 6f 77 3b 0a 20 20 63 |ous = &zlow;. c|
00002960 20 3d 20 6d 65 72 67 65 5f 78 28 73 6f 72 74 5f | = merge_x(sort_|
00002970 78 28 61 2c 20 6e 2f 32 29 2c 20 73 6f 72 74 5f |x(a, n/2), sort_|
00002980 78 28 62 2c 20 6e 2d 6e 2f 32 29 29 3b 0a 20 20 |x(b, n-n/2));. |
00002990 72 65 74 75 72 6e 20 63 3b 0a 7d 0a 0a 76 6f 69 |return c;.}..voi|
000029a0 64 20 6d 6f 76 65 5f 62 6f 69 64 73 28 76 6f 69 |d move_boids(voi|
000029b0 64 29 0a 7b 0a 20 20 69 6e 74 20 69 2c 20 6a 2c |d).{. int i, j,|
000029c0 20 64 3b 0a 20 20 69 6e 74 20 78 2c 20 79 2c 20 | d;. int x, y, |
000029d0 76 78 2c 20 76 79 3b 0a 20 20 69 6e 74 20 61 2c |vx, vy;. int a,|
000029e0 20 62 3b 0a 20 20 69 6e 74 20 6b 2c 20 6c 2c 20 | b;. int k, l, |
000029f0 70 2c 20 71 3b 0a 20 20 67 6e 6f 64 65 20 2a 74 |p, q;. gnode *t|
00002a00 3b 0a 2f 2a 20 20 69 6e 74 20 72 78 2c 20 72 79 |;./* int rx, ry|
00002a10 3b 2a 2f 0a 20 20 62 6f 69 64 5f 64 61 74 61 20 |;*/. boid_data |
00002a20 2a 62 70 2c 20 2a 62 70 65 3b 0a 20 20 66 6f 72 |*bp, *bpe;. for|
00002a30 20 28 62 70 3d 62 6f 69 64 2c 62 70 65 3d 62 70 | (bp=boid,bpe=bp|
00002a40 2b 6e 3b 20 62 70 3c 62 70 65 3b 20 62 70 2b 2b |+n; bp<bpe; bp++|
00002a50 29 20 7b 0a 20 20 20 20 62 70 2d 3e 64 6d 3d 30 |) {. bp->dm=0|
00002a60 78 37 66 66 66 66 66 66 66 3b 0a 20 20 20 20 62 |x7fffffff;. b|
00002a70 70 2d 3e 61 78 3d 62 70 2d 3e 61 79 3d 62 70 2d |p->ax=bp->ay=bp-|
00002a80 3e 61 76 78 3d 62 70 2d 3e 61 76 79 3d 62 70 2d |>avx=bp->avy=bp-|
00002a90 3e 61 63 3d 30 3b 0a 20 20 7d 0a 20 20 74 6e 32 |>ac=0;. }. tn2|
00002aa0 3d 63 6c 6f 63 6b 28 29 3b 0a 2f 2a 0a 20 20 66 |=clock();./*. f|
00002ab0 6f 72 20 28 69 3d 30 3b 20 69 3c 6e 2d 31 3b 20 |or (i=0; i<n-1; |
00002ac0 69 2b 2b 29 0a 20 20 20 20 66 6f 72 20 28 6a 3d |i++). for (j=|
00002ad0 69 2b 31 3b 20 6a 3c 6e 3b 20 6a 2b 2b 29 20 7b |i+1; j<n; j++) {|
00002ae0 0a 20 20 20 20 20 20 61 20 3d 20 28 72 78 3d 62 |. a = (rx=b|
00002af0 6f 69 64 5b 69 5d 2e 78 2d 62 6f 69 64 5b 6a 5d |oid[i].x-boid[j]|
00002b00 2e 78 29 2f 6f 6e 65 3b 0a 20 20 20 20 20 20 61 |.x)/one;. a|
00002b10 20 3d 20 61 2a 61 3b 0a 20 20 20 20 20 20 69 66 | = a*a;. if|
00002b20 20 28 61 3c 72 6c 32 2f 31 30 32 34 29 20 7b 0a | (a<rl2/1024) {.|
00002b30 20 20 20 20 20 20 20 20 62 20 3d 20 28 72 79 3d | b = (ry=|
00002b40 62 6f 69 64 5b 69 5d 2e 79 2d 62 6f 69 64 5b 6a |boid[i].y-boid[j|
00002b50 5d 2e 79 29 2f 6f 6e 65 3b 0a 20 20 20 20 20 20 |].y)/one;. |
00002b60 20 20 61 20 2b 3d 20 62 2a 62 3b 0a 20 20 20 20 | a += b*b;. |
00002b70 20 20 20 20 69 66 20 28 61 3c 72 6c 32 2f 31 30 | if (a<rl2/10|
00002b80 32 34 29 20 7b 0a 20 20 20 20 20 20 20 20 20 20 |24) {. |
00002b90 64 20 3d 20 6d 75 6c 31 36 31 30 28 72 78 2c 72 |d = mul1610(rx,r|
00002ba0 78 29 20 2b 20 6d 75 6c 31 36 31 30 28 72 79 2c |x) + mul1610(ry,|
00002bb0 72 79 29 3b 0a 20 20 20 20 20 20 20 20 20 20 69 |ry);. i|
00002bc0 66 20 28 64 3c 72 6c 32 29 20 7b 0a 20 20 20 20 |f (d<rl2) {. |
00002bd0 20 20 20 20 20 20 20 20 62 6f 69 64 5b 69 5d 2e | boid[i].|
00002be0 61 78 20 20 2b 3d 20 62 6f 69 64 5b 6a 5d 2e 78 |ax += boid[j].x|
00002bf0 2d 62 6f 69 64 5b 69 5d 2e 78 3b 0a 20 20 20 20 |-boid[i].x;. |
00002c00 20 20 20 20 20 20 20 20 62 6f 69 64 5b 69 5d 2e | boid[i].|
00002c10 61 79 20 20 2b 3d 20 62 6f 69 64 5b 6a 5d 2e 79 |ay += boid[j].y|
00002c20 2d 62 6f 69 64 5b 69 5d 2e 79 3b 0a 20 20 20 20 |-boid[i].y;. |
00002c30 20 20 20 20 20 20 20 20 62 6f 69 64 5b 69 5d 2e | boid[i].|
00002c40 61 76 78 20 2b 3d 20 62 6f 69 64 5b 6a 5d 2e 76 |avx += boid[j].v|
00002c50 78 3b 0a 20 20 20 20 20 20 20 20 20 20 20 20 62 |x;. b|
00002c60 6f 69 64 5b 69 5d 2e 61 76 79 20 2b 3d 20 62 6f |oid[i].avy += bo|
00002c70 69 64 5b 6a 5d 2e 76 79 3b 0a 20 20 20 20 20 20 |id[j].vy;. |
00002c80 20 20 20 20 20 20 62 6f 69 64 5b 69 5d 2e 61 63 | boid[i].ac|
00002c90 20 20 2b 3d 20 31 3b 0a 20 20 20 20 20 20 20 20 | += 1;. |
00002ca0 20 20 20 20 62 6f 69 64 5b 6a 5d 2e 61 78 20 20 | boid[j].ax |
00002cb0 2b 3d 20 62 6f 69 64 5b 69 5d 2e 78 2d 62 6f 69 |+= boid[i].x-boi|
00002cc0 64 5b 6a 5d 2e 78 3b 0a 20 20 20 20 20 20 20 20 |d[j].x;. |
00002cd0 20 20 20 20 62 6f 69 64 5b 6a 5d 2e 61 79 20 20 | boid[j].ay |
00002ce0 2b 3d 20 62 6f 69 64 5b 69 5d 2e 79 2d 62 6f 69 |+= boid[i].y-boi|
00002cf0 64 5b 6a 5d 2e 79 3b 0a 20 20 20 20 20 20 20 20 |d[j].y;. |
00002d00 20 20 20 20 62 6f 69 64 5b 6a 5d 2e 61 76 78 20 | boid[j].avx |
00002d10 2b 3d 20 62 6f 69 64 5b 69 5d 2e 76 78 3b 0a 20 |+= boid[i].vx;. |
00002d20 20 20 20 20 20 20 20 20 20 20 20 62 6f 69 64 5b | boid[|
00002d30 6a 5d 2e 61 76 79 20 2b 3d 20 62 6f 69 64 5b 69 |j].avy += boid[i|
00002d40 5d 2e 76 79 3b 0a 20 20 20 20 20 20 20 20 20 20 |].vy;. |
00002d50 20 20 62 6f 69 64 5b 6a 5d 2e 61 63 20 20 2b 3d | boid[j].ac +=|
00002d60 20 31 3b 0a 20 20 20 20 20 20 20 20 20 20 7d 0a | 1;. }.|
00002d70 20 20 20 20 20 20 20 20 7d 0a 20 20 20 20 20 20 | }. |
00002d80 7d 0a 20 20 20 20 7d 0a 2a 2f 0a 20 20 2f 2a 72 |}. }.*/. /*r|
00002d90 61 6e 67 65 20 63 68 65 63 6b 69 6e 67 2a 2f 0a |ange checking*/.|
00002da0 20 20 6d 65 6d 73 65 74 28 67 72 69 64 2c 20 30 | memset(grid, 0|
00002db0 2c 20 73 69 7a 65 6f 66 28 67 6e 6f 64 65 20 2a |, sizeof(gnode *|
00002dc0 29 2a 28 6d 61 78 67 78 2b 31 29 2a 28 6d 61 78 |)*(maxgx+1)*(max|
00002dd0 67 79 2b 31 29 29 3b 0a 20 20 66 6f 72 20 28 69 |gy+1));. for (i|
00002de0 3d 30 3b 20 69 3c 6e 3b 20 69 2b 2b 29 20 7b 09 |=0; i<n; i++) {.|
00002df0 09 2f 2a 66 69 72 73 74 20 77 65 20 69 6e 73 65 |./*first we inse|
00002e00 72 74 20 61 6c 6c 20 62 6f 69 64 73 20 69 6e 74 |rt all boids int|
00002e10 6f 20 67 72 69 64 2a 2f 0a 20 20 20 20 61 20 3d |o grid*/. a =|
00002e20 20 78 74 6f 67 69 28 62 6f 69 64 5b 69 5d 2e 78 | xtogi(boid[i].x|
00002e30 29 3b 0a 20 20 20 20 69 66 20 28 61 3c 30 29 20 |);. if (a<0) |
00002e40 61 3d 30 3b 0a 20 20 20 20 69 66 20 28 61 3e 6d |a=0;. if (a>m|
00002e50 61 78 67 78 29 20 61 3d 6d 61 78 67 78 3b 0a 20 |axgx) a=maxgx;. |
00002e60 20 20 20 62 20 3d 20 79 74 6f 67 69 28 62 6f 69 | b = ytogi(boi|
00002e70 64 5b 69 5d 2e 79 29 3b 0a 20 20 20 20 69 66 20 |d[i].y);. if |
00002e80 28 62 3c 30 29 20 62 3d 30 3b 0a 20 20 20 20 69 |(b<0) b=0;. i|
00002e90 66 20 28 62 3e 6d 61 78 67 79 29 20 62 3d 6d 61 |f (b>maxgy) b=ma|
00002ea0 78 67 79 3b 20 20 0a 20 20 20 20 6a 20 3d 20 61 |xgy; . j = a|
00002eb0 2b 28 6d 61 78 67 78 2b 31 29 2a 62 3b 0a 20 20 |+(maxgx+1)*b;. |
00002ec0 20 20 62 6f 69 64 67 6e 6f 64 65 5b 69 5d 2e 6e | boidgnode[i].n|
00002ed0 65 78 74 20 3d 20 67 72 69 64 5b 6a 5d 3b 0a 20 |ext = grid[j];. |
00002ee0 20 20 20 67 72 69 64 5b 6a 5d 20 3d 20 62 6f 69 | grid[j] = boi|
00002ef0 64 67 6e 6f 64 65 2b 69 3b 0a 20 20 7d 0a 20 20 |dgnode+i;. }. |
00002f00 66 6f 72 20 28 69 3d 30 3b 20 69 3c 6e 3b 20 69 |for (i=0; i<n; i|
00002f10 2b 2b 29 20 7b 09 09 2f 2a 74 68 65 6e 20 77 65 |++) {../*then we|
00002f20 20 72 61 6e 67 65 20 63 68 65 63 6b 20 76 69 61 | range check via|
00002f30 20 74 68 65 20 67 72 69 64 2a 2f 0a 20 20 20 20 | the grid*/. |
00002f40 61 20 3d 20 78 74 6f 67 69 28 62 6f 69 64 5b 69 |a = xtogi(boid[i|
00002f50 5d 2e 78 29 3b 0a 20 20 20 20 69 66 20 28 61 3c |].x);. if (a<|
00002f60 30 29 20 61 3d 30 3b 0a 20 20 20 20 69 66 20 28 |0) a=0;. if (|
00002f70 61 3e 6d 61 78 67 78 29 20 61 3d 6d 61 78 67 78 |a>maxgx) a=maxgx|
00002f80 3b 0a 20 20 20 20 62 20 3d 20 79 74 6f 67 69 28 |;. b = ytogi(|
00002f90 62 6f 69 64 5b 69 5d 2e 79 29 3b 0a 20 20 20 20 |boid[i].y);. |
00002fa0 69 66 20 28 62 3c 30 29 20 62 3d 30 3b 0a 20 20 |if (b<0) b=0;. |
00002fb0 20 20 69 66 20 28 62 3e 6d 61 78 67 79 29 20 62 | if (b>maxgy) b|
00002fc0 3d 6d 61 78 67 79 3b 20 20 0a 20 20 20 20 6b 20 |=maxgy; . k |
00002fd0 3d 20 61 2d 67 72 6c 3c 30 20 3f 20 30 20 3a 20 |= a-grl<0 ? 0 : |
00002fe0 61 2d 67 72 6c 3b 0a 20 20 20 20 6c 20 3d 20 62 |a-grl;. l = b|
00002ff0 2d 67 72 6c 3c 30 20 3f 20 30 20 3a 20 62 2d 67 |-grl<0 ? 0 : b-g|
00003000 72 6c 3b 0a 20 20 20 20 70 20 3d 20 61 2b 67 72 |rl;. p = a+gr|
00003010 6c 3e 6d 61 78 67 78 20 3f 20 6d 61 78 67 78 20 |l>maxgx ? maxgx |
00003020 3a 20 61 2b 67 72 6c 3b 0a 20 20 20 20 71 20 3d |: a+grl;. q =|
00003030 20 62 2b 67 72 6c 3e 6d 61 78 67 79 20 3f 20 6d | b+grl>maxgy ? m|
00003040 61 78 67 79 20 3a 20 62 2b 67 72 6c 3b 0a 20 20 |axgy : b+grl;. |
00003050 20 20 66 6f 72 20 28 79 3d 6c 3b 20 79 3c 3d 71 | for (y=l; y<=q|
00003060 3b 20 79 2b 2b 29 0a 20 20 20 20 20 20 66 6f 72 |; y++). for|
00003070 20 28 78 3d 6b 3b 20 78 3c 3d 70 3b 20 78 2b 2b | (x=k; x<=p; x++|
00003080 29 0a 20 20 20 20 20 20 20 20 69 66 20 28 67 6d |). if (gm|
00003090 61 73 6b 5b 61 62 73 28 78 2d 61 29 2b 28 67 72 |ask[abs(x-a)+(gr|
000030a0 6c 2b 31 29 2a 61 62 73 28 79 2d 62 29 5d 29 20 |l+1)*abs(y-b)]) |
000030b0 7b 0a 20 20 20 20 20 20 20 20 20 20 66 6f 72 20 |{. for |
000030c0 28 74 3d 67 72 69 64 5b 78 2b 28 6d 61 78 67 78 |(t=grid[x+(maxgx|
000030d0 2b 31 29 2a 79 5d 3b 20 74 21 3d 30 3b 20 74 3d |+1)*y]; t!=0; t=|
000030e0 74 2d 3e 6e 65 78 74 29 20 7b 0a 20 20 20 20 20 |t->next) {. |
000030f0 20 20 20 20 20 20 20 6a 20 3d 20 74 2d 62 6f 69 | j = t-boi|
00003100 64 67 6e 6f 64 65 3b 0a 20 20 20 20 20 20 20 20 |dgnode;. |
00003110 20 20 20 20 69 66 20 28 69 3c 6a 29 20 7b 0a 20 | if (i<j) {. |
00003120 20 20 20 20 20 20 20 20 20 20 20 20 20 64 20 3d | d =|
00003130 20 73 71 75 61 72 65 31 36 31 30 28 62 6f 69 64 | square1610(boid|
00003140 5b 69 5d 2e 78 2d 62 6f 69 64 5b 6a 5d 2e 78 29 |[i].x-boid[j].x)|
00003150 20 2b 20 73 71 75 61 72 65 31 36 31 30 28 62 6f | + square1610(bo|
00003160 69 64 5b 69 5d 2e 79 2d 62 6f 69 64 5b 6a 5d 2e |id[i].y-boid[j].|
00003170 79 29 3b 0a 20 20 20 20 20 20 20 20 20 20 20 20 |y);. |
00003180 20 20 69 66 20 28 64 3c 72 6c 32 29 20 7b 0a 20 | if (d<rl2) {. |
00003190 20 20 20 20 20 20 20 20 20 20 20 20 20 20 20 62 | b|
000031a0 6f 69 64 5b 69 5d 2e 61 78 20 20 2b 3d 20 62 6f |oid[i].ax += bo|
000031b0 69 64 5b 6a 5d 2e 78 2d 62 6f 69 64 5b 69 5d 2e |id[j].x-boid[i].|
000031c0 78 3b 0a 20 20 20 20 20 20 20 20 20 20 20 20 20 |x;. |
000031d0 20 20 20 62 6f 69 64 5b 69 5d 2e 61 79 20 20 2b | boid[i].ay +|
000031e0 3d 20 62 6f 69 64 5b 6a 5d 2e 79 2d 62 6f 69 64 |= boid[j].y-boid|
000031f0 5b 69 5d 2e 79 3b 0a 20 20 20 20 20 20 20 20 20 |[i].y;. |
00003200 20 20 20 20 20 20 20 62 6f 69 64 5b 69 5d 2e 61 | boid[i].a|
00003210 76 78 20 2b 3d 20 62 6f 69 64 5b 6a 5d 2e 76 78 |vx += boid[j].vx|
00003220 3b 0a 20 20 20 20 20 20 20 20 20 20 20 20 20 20 |;. |
00003230 20 20 62 6f 69 64 5b 69 5d 2e 61 76 79 20 2b 3d | boid[i].avy +=|
00003240 20 62 6f 69 64 5b 6a 5d 2e 76 79 3b 0a 20 20 20 | boid[j].vy;. |
00003250 20 20 20 20 20 20 20 20 20 20 20 20 20 62 6f 69 | boi|
00003260 64 5b 69 5d 2e 61 63 20 20 2b 3d 20 31 3b 0a 20 |d[i].ac += 1;. |
00003270 20 20 20 20 20 20 20 20 20 20 20 20 20 20 20 62 | b|
00003280 6f 69 64 5b 6a 5d 2e 61 78 20 20 2b 3d 20 62 6f |oid[j].ax += bo|
00003290 69 64 5b 69 5d 2e 78 2d 62 6f 69 64 5b 6a 5d 2e |id[i].x-boid[j].|
000032a0 78 3b 0a 20 20 20 20 20 20 20 20 20 20 20 20 20 |x;. |
000032b0 20 20 20 62 6f 69 64 5b 6a 5d 2e 61 79 20 20 2b | boid[j].ay +|
000032c0 3d 20 62 6f 69 64 5b 69 5d 2e 79 2d 62 6f 69 64 |= boid[i].y-boid|
000032d0 5b 6a 5d 2e 79 3b 0a 20 20 20 20 20 20 20 20 20 |[j].y;. |
000032e0 20 20 20 20 20 20 20 62 6f 69 64 5b 6a 5d 2e 61 | boid[j].a|
000032f0 76 78 20 2b 3d 20 62 6f 69 64 5b 69 5d 2e 76 78 |vx += boid[i].vx|
00003300 3b 0a 20 20 20 20 20 20 20 20 20 20 20 20 20 20 |;. |
00003310 20 20 62 6f 69 64 5b 6a 5d 2e 61 76 79 20 2b 3d | boid[j].avy +=|
00003320 20 62 6f 69 64 5b 69 5d 2e 76 79 3b 0a 20 20 20 | boid[i].vy;. |
00003330 20 20 20 20 20 20 20 20 20 20 20 20 20 62 6f 69 | boi|
00003340 64 5b 6a 5d 2e 61 63 20 20 2b 3d 20 31 3b 0a 20 |d[j].ac += 1;. |
00003350 20 20 20 20 20 20 20 20 20 20 20 20 20 7d 0a 20 | }. |
00003360 20 20 20 20 20 20 20 20 20 20 20 7d 0a 20 20 20 | }. |
00003370 20 20 20 20 20 20 20 7d 0a 20 20 20 20 20 20 20 | }. |
00003380 20 7d 0a 20 20 7d 0a 0a 2f 2a 20 20 20 20 0a 20 | }. }../* . |
00003390 20 66 6f 72 20 28 69 3d 30 3b 20 69 3c 6e 2d 31 | for (i=0; i<n-1|
000033a0 3b 20 69 2b 2b 29 0a 20 20 20 20 66 6f 72 20 28 |; i++). for (|
000033b0 6a 3d 69 2b 31 3b 20 6a 3c 6e 3b 20 6a 2b 2b 29 |j=i+1; j<n; j++)|
000033c0 20 7b 0a 20 20 20 20 20 20 61 20 3d 20 28 72 78 | {. a = (rx|
000033d0 3d 62 6f 69 64 5b 69 5d 2e 78 2d 62 6f 69 64 5b |=boid[i].x-boid[|
000033e0 6a 5d 2e 78 29 2f 6f 6e 65 3b 0a 20 20 20 20 20 |j].x)/one;. |
000033f0 20 61 20 3d 20 61 2a 61 3b 0a 20 20 20 20 20 20 | a = a*a;. |
00003400 69 66 20 28 61 3c 62 6f 69 64 5b 69 5d 2e 64 6d |if (a<boid[i].dm|
00003410 2f 31 30 32 34 20 7c 7c 20 61 3c 62 6f 69 64 5b |/1024 || a<boid[|
00003420 6a 5d 2e 64 6d 2f 31 30 32 34 29 20 7b 0a 20 20 |j].dm/1024) {. |
00003430 20 20 20 20 20 20 62 20 3d 20 28 72 79 3d 62 6f | b = (ry=bo|
00003440 69 64 5b 69 5d 2e 79 2d 62 6f 69 64 5b 6a 5d 2e |id[i].y-boid[j].|
00003450 79 29 2f 6f 6e 65 3b 0a 20 20 20 20 20 20 20 20 |y)/one;. |
00003460 61 20 2b 3d 20 62 2a 62 3b 0a 20 20 20 20 20 20 |a += b*b;. |
00003470 20 20 69 66 20 28 61 3c 62 6f 69 64 5b 69 5d 2e | if (a<boid[i].|
00003480 64 6d 2f 31 30 32 34 20 7c 7c 20 61 3c 62 6f 69 |dm/1024 || a<boi|
00003490 64 5b 6a 5d 2e 64 6d 2f 31 30 32 34 29 20 7b 0a |d[j].dm/1024) {.|
000034a0 20 20 20 20 20 20 20 20 20 20 64 20 3d 20 6d 75 | d = mu|
000034b0 6c 31 36 31 30 28 72 78 2c 72 78 29 20 2b 20 6d |l1610(rx,rx) + m|
000034c0 75 6c 31 36 31 30 28 72 79 2c 72 79 29 3b 0a 20 |ul1610(ry,ry);. |
000034d0 20 20 20 20 20 20 20 20 20 69 66 20 28 64 3c 62 | if (d<b|
000034e0 6f 69 64 5b 69 5d 2e 64 6d 29 20 7b 0a 20 20 20 |oid[i].dm) {. |
000034f0 20 20 20 20 20 20 20 20 20 62 6f 69 64 5b 69 5d | boid[i]|
00003500 2e 64 6d 20 3d 20 64 3b 0a 20 20 20 20 20 20 20 |.dm = d;. |
00003510 20 20 20 20 20 62 6f 69 64 5b 69 5d 2e 69 6d 20 | boid[i].im |
00003520 3d 20 6a 3b 0a 20 20 20 20 20 20 20 20 20 20 7d |= j;. }|
00003530 0a 20 20 20 20 20 20 20 20 20 20 69 66 20 28 64 |. if (d|
00003540 3c 62 6f 69 64 5b 6a 5d 2e 64 6d 29 20 7b 0a 20 |<boid[j].dm) {. |
00003550 20 20 20 20 20 20 20 20 20 20 20 62 6f 69 64 5b | boid[|
00003560 6a 5d 2e 64 6d 20 3d 20 64 3b 0a 20 20 20 20 20 |j].dm = d;. |
00003570 20 20 20 20 20 20 20 62 6f 69 64 5b 6a 5d 2e 69 | boid[j].i|
00003580 6d 20 3d 20 69 3b 0a 20 20 20 20 20 20 20 20 20 |m = i;. |
00003590 20 7d 0a 20 20 20 20 20 20 20 20 7d 0a 20 20 20 | }. }. |
000035a0 20 20 20 7d 0a 20 20 20 20 7d 0a 2a 2f 0a 20 20 | }. }.*/. |
000035b0 2f 2a 6d 69 6e 69 6d 75 6d 20 64 69 73 74 61 6e |/*minimum distan|
000035c0 63 65 20 63 61 6c 63 75 6c 61 74 69 6f 6e 2a 2f |ce calculation*/|
000035d0 0a 20 20 68 20 3d 20 73 6f 72 74 5f 78 28 68 2c |. h = sort_x(h,|
000035e0 20 6e 29 3b 0a 20 20 68 20 3d 20 73 6f 72 74 5f | n);. h = sort_|
000035f0 79 28 68 2c 20 6e 29 3b 0a 20 20 20 20 0a 20 20 |y(h, n);. . |
00003600 74 6e 32 3d 63 6c 6f 63 6b 28 29 2d 74 6e 32 3b |tn2=clock()-tn2;|
00003610 0a 20 20 66 6f 72 20 28 69 3d 30 3b 20 69 3c 6e |. for (i=0; i<n|
00003620 3b 20 69 2b 2b 29 20 7b 0a 20 20 20 20 78 20 20 |; i++) {. x |
00003630 3d 20 62 6f 69 64 5b 69 5d 2e 78 3b 0a 20 20 20 |= boid[i].x;. |
00003640 20 79 20 20 3d 20 62 6f 69 64 5b 69 5d 2e 79 3b | y = boid[i].y;|
00003650 0a 20 20 20 20 76 78 20 3d 20 62 6f 69 64 5b 69 |. vx = boid[i|
00003660 5d 2e 76 78 3b 0a 20 20 20 20 76 79 20 3d 20 62 |].vx;. vy = b|
00003670 6f 69 64 5b 69 5d 2e 76 79 3b 0a 20 20 20 20 69 |oid[i].vy;. i|
00003680 66 20 28 62 6f 69 64 5b 69 5d 2e 61 63 3c 31 29 |f (boid[i].ac<1)|
00003690 20 7b 0a 20 20 20 20 20 20 6a 20 3d 20 62 6f 69 | {. j = boi|
000036a0 64 5b 69 5d 2e 69 6d 3b 0a 20 20 20 20 20 20 62 |d[i].im;. b|
000036b0 6f 69 64 5b 69 5d 2e 61 78 20 20 2b 3d 20 62 6f |oid[i].ax += bo|
000036c0 69 64 5b 6a 5d 2e 78 2d 78 3b 0a 20 20 20 20 20 |id[j].x-x;. |
000036d0 20 62 6f 69 64 5b 69 5d 2e 61 79 20 20 2b 3d 20 | boid[i].ay += |
000036e0 62 6f 69 64 5b 6a 5d 2e 79 2d 79 3b 0a 20 20 20 |boid[j].y-y;. |
000036f0 20 20 20 62 6f 69 64 5b 69 5d 2e 61 76 78 20 2b | boid[i].avx +|
00003700 3d 20 62 6f 69 64 5b 6a 5d 2e 76 78 3b 0a 20 20 |= boid[j].vx;. |
00003710 20 20 20 20 62 6f 69 64 5b 69 5d 2e 61 76 79 20 | boid[i].avy |
00003720 2b 3d 20 62 6f 69 64 5b 6a 5d 2e 76 79 3b 0a 20 |+= boid[j].vy;. |
00003730 20 20 20 20 20 62 6f 69 64 5b 69 5d 2e 61 63 20 | boid[i].ac |
00003740 20 2b 3d 20 31 3b 0a 20 20 20 20 7d 0a 20 20 20 | += 1;. }. |
00003750 20 69 66 20 28 78 3c 72 63 2d 36 34 30 2a 6f 6e | if (x<rc-640*on|
00003760 65 20 7c 7c 20 78 3e 36 34 30 2a 6f 6e 65 2d 72 |e || x>640*one-r|
00003770 63 20 7c 7c 20 79 3c 72 63 2d 35 31 32 2a 6f 6e |c || y<rc-512*on|
00003780 65 20 7c 7c 20 79 3e 35 31 32 2a 6f 6e 65 2d 72 |e || y>512*one-r|
00003790 63 29 20 7b 0a 20 20 20 20 20 20 69 66 20 28 78 |c) {. if (x|
000037a0 3c 72 63 2d 36 34 30 2a 6f 6e 65 26 26 76 78 3c |<rc-640*one&&vx<|
000037b0 30 20 7c 7c 20 78 3e 36 34 30 2a 6f 6e 65 2d 72 |0 || x>640*one-r|
000037c0 63 26 26 76 78 3e 30 29 20 76 78 3d 2d 76 78 3b |c&&vx>0) vx=-vx;|
000037d0 0a 20 20 20 20 20 20 69 66 20 28 79 3c 72 63 2d |. if (y<rc-|
000037e0 35 31 32 2a 6f 6e 65 26 26 76 79 3c 30 20 7c 7c |512*one&&vy<0 |||
000037f0 20 79 3e 35 31 32 2a 6f 6e 65 2d 72 63 26 26 76 | y>512*one-rc&&v|
00003800 79 3e 30 29 20 76 79 3d 2d 76 79 3b 0a 20 20 20 |y>0) vy=-vy;. |
00003810 20 7d 0a 20 20 20 20 65 6c 73 65 20 7b 0a 20 20 | }. else {. |
00003820 20 20 20 20 66 6f 72 20 28 6a 3d 30 3b 20 6a 3c | for (j=0; j<|
00003830 70 6e 3b 20 6a 2b 2b 29 20 7b 0a 20 20 20 20 20 |pn; j++) {. |
00003840 20 20 20 69 66 20 28 61 62 73 28 70 69 6c 6c 61 | if (abs(pilla|
00003850 72 5b 6a 5d 2e 78 2d 78 29 3c 70 69 6c 6c 61 72 |r[j].x-x)<pillar|
00003860 5b 6a 5d 2e 72 20 26 26 20 61 62 73 28 70 69 6c |[j].r && abs(pil|
00003870 6c 61 72 5b 6a 5d 2e 79 2d 79 29 3c 70 69 6c 6c |lar[j].y-y)<pill|
00003880 61 72 5b 6a 5d 2e 72 29 20 7b 0a 20 20 20 20 20 |ar[j].r) {. |
00003890 20 20 20 20 20 64 20 3d 20 6d 75 6c 31 36 31 30 | d = mul1610|
000038a0 28 70 69 6c 6c 61 72 5b 6a 5d 2e 78 2d 78 2c 70 |(pillar[j].x-x,p|
000038b0 69 6c 6c 61 72 5b 6a 5d 2e 78 2d 78 29 20 2b 20 |illar[j].x-x) + |
000038c0 6d 75 6c 31 36 31 30 28 70 69 6c 6c 61 72 5b 6a |mul1610(pillar[j|
000038d0 5d 2e 79 2d 79 2c 70 69 6c 6c 61 72 5b 6a 5d 2e |].y-y,pillar[j].|
000038e0 79 2d 79 29 3b 0a 20 20 20 20 20 20 20 20 20 20 |y-y);. |
000038f0 69 66 20 28 64 20 3c 20 70 69 6c 6c 61 72 5b 6a |if (d < pillar[j|
00003900 5d 2e 72 32 29 20 7b 0a 20 20 20 20 20 20 20 20 |].r2) {. |
00003910 20 20 20 20 6a 2b 3d 30 78 31 30 30 30 30 3b 0a | j+=0x10000;.|
00003920 20 20 20 20 20 20 20 20 20 20 20 20 62 72 65 61 | brea|
00003930 6b 3b 0a 20 20 20 20 20 20 20 20 20 20 7d 0a 20 |k;. }. |
00003940 20 20 20 20 20 20 20 7d 0a 20 20 20 20 20 20 7d | }. }|
00003950 0a 20 20 20 20 20 20 69 66 20 28 6a 20 26 20 30 |. if (j & 0|
00003960 78 31 30 30 30 30 29 20 7b 0a 20 20 20 20 20 20 |x10000) {. |
00003970 20 20 6a 2d 3d 30 78 31 30 30 30 30 3b 0a 20 20 | j-=0x10000;. |
00003980 20 20 20 20 20 20 62 6f 75 6e 63 65 28 70 69 6c | bounce(pil|
00003990 6c 61 72 5b 6a 5d 2e 78 2d 78 2c 20 70 69 6c 6c |lar[j].x-x, pill|
000039a0 61 72 5b 6a 5d 2e 79 2d 79 2c 20 26 76 78 2c 20 |ar[j].y-y, &vx, |
000039b0 26 76 79 2c 20 64 29 3b 0a 20 20 20 20 20 20 7d |&vy, d);. }|
000039c0 0a 20 20 20 20 20 20 65 6c 73 65 20 69 66 20 28 |. else if (|
000039d0 62 6f 69 64 5b 69 5d 2e 64 6d 3c 72 63 32 29 20 |boid[i].dm<rc2) |
000039e0 62 6f 75 6e 63 65 28 62 6f 69 64 5b 62 6f 69 64 |bounce(boid[boid|
000039f0 5b 69 5d 2e 69 6d 5d 2e 78 2d 78 2c 20 62 6f 69 |[i].im].x-x, boi|
00003a00 64 5b 62 6f 69 64 5b 69 5d 2e 69 6d 5d 2e 79 2d |d[boid[i].im].y-|
00003a10 79 2c 20 26 76 78 2c 20 26 76 79 2c 20 62 6f 69 |y, &vx, &vy, boi|
00003a20 64 5b 69 5d 2e 64 6d 29 3b 0a 20 20 20 20 20 20 |d[i].dm);. |
00003a30 65 6c 73 65 20 7b 0a 20 20 20 20 20 20 20 20 61 |else {. a|
00003a40 20 3d 20 62 6f 69 64 5b 69 5d 2e 61 78 2f 62 6f | = boid[i].ax/bo|
00003a50 69 64 5b 69 5d 2e 61 63 3b 0a 20 20 20 20 20 20 |id[i].ac;. |
00003a60 20 20 62 20 3d 20 62 6f 69 64 5b 69 5d 2e 61 79 | b = boid[i].ay|
00003a70 2f 62 6f 69 64 5b 69 5d 2e 61 63 3b 0a 20 20 20 |/boid[i].ac;. |
00003a80 20 20 20 20 20 64 20 3d 20 6d 61 67 6e 69 74 75 | d = magnitu|
00003a90 64 65 28 61 2c 62 29 3b 0a 20 20 20 20 20 20 20 |de(a,b);. |
00003aa0 20 61 20 3d 20 64 69 76 5f 66 72 61 63 31 36 28 | a = div_frac16(|
00003ab0 61 2c 64 29 3b 0a 20 20 20 20 20 20 20 20 62 20 |a,d);. b |
00003ac0 3d 20 64 69 76 5f 66 72 61 63 31 36 28 62 2c 64 |= div_frac16(b,d|
00003ad0 29 3b 0a 20 20 20 20 20 20 20 20 64 20 3d 20 6e |);. d = n|
00003ae0 65 61 72 65 73 74 73 5f 73 71 72 74 28 69 29 3b |earests_sqrt(i);|
00003af0 0a 20 20 20 20 20 20 20 20 69 66 20 28 64 3c 72 |. if (d<r|
00003b00 6d 29 20 7b 0a 20 20 20 20 20 20 20 20 20 20 76 |m) {. v|
00003b10 78 20 3d 20 64 69 76 5f 66 72 61 63 31 36 28 20 |x = div_frac16( |
00003b20 6d 75 6c 5f 66 72 61 63 31 36 28 62 6f 69 64 5b |mul_frac16(boid[|
00003b30 69 5d 2e 61 76 78 2f 62 6f 69 64 5b 69 5d 2e 61 |i].avx/boid[i].a|
00003b40 63 2c 20 72 6d 2d 64 29 2b 6d 75 6c 5f 66 72 61 |c, rm-d)+mul_fra|
00003b50 63 31 36 28 64 2d 72 63 2c 20 61 2a 67 29 20 2c |c16(d-rc, a*g) ,|
00003b60 20 72 6d 2d 72 63 20 29 3b 0a 20 20 20 20 20 20 | rm-rc );. |
00003b70 20 20 20 20 76 79 20 3d 20 64 69 76 5f 66 72 61 | vy = div_fra|
00003b80 63 31 36 28 20 6d 75 6c 5f 66 72 61 63 31 36 28 |c16( mul_frac16(|
00003b90 62 6f 69 64 5b 69 5d 2e 61 76 79 2f 62 6f 69 64 |boid[i].avy/boid|
00003ba0 5b 69 5d 2e 61 63 2c 20 72 6d 2d 64 29 2b 6d 75 |[i].ac, rm-d)+mu|
00003bb0 6c 5f 66 72 61 63 31 36 28 64 2d 72 63 2c 20 62 |l_frac16(d-rc, b|
00003bc0 2a 67 29 20 2c 20 72 6d 2d 72 63 20 29 3b 0a 20 |*g) , rm-rc );. |
00003bd0 20 20 20 20 20 20 20 7d 0a 20 20 20 20 20 20 20 | }. |
00003be0 20 65 6c 73 65 20 7b 0a 20 20 20 20 20 20 20 20 | else {. |
00003bf0 20 20 64 20 20 3d 20 64 69 76 5f 66 72 61 63 31 | d = div_frac1|
00003c00 36 28 64 2c 20 72 6d 29 3b 0a 20 20 20 20 20 20 |6(d, rm);. |
00003c10 20 20 20 20 69 66 20 28 64 3e 31 36 2a 6f 6e 65 | if (d>16*one|
00003c20 29 20 64 3d 31 36 2a 6f 6e 65 3b 09 2f 2a 70 72 |) d=16*one;./*pr|
00003c30 65 76 65 6e 74 20 72 69 64 69 63 75 6c 6f 75 73 |event ridiculous|
00003c40 6c 79 20 68 69 67 68 20 63 61 74 63 68 20 75 70 |ly high catch up|
00003c50 20 73 70 65 65 64 73 2a 2f 0a 20 20 20 20 20 20 | speeds*/. |
00003c60 20 20 20 20 76 78 20 3d 20 6d 75 6c 5f 66 72 61 | vx = mul_fra|
00003c70 63 31 36 28 64 2c 20 61 2a 67 29 3b 0a 20 20 20 |c16(d, a*g);. |
00003c80 20 20 20 20 20 20 20 76 79 20 3d 20 6d 75 6c 5f | vy = mul_|
00003c90 66 72 61 63 31 36 28 64 2c 20 62 2a 67 29 3b 0a |frac16(d, b*g);.|
00003ca0 20 20 20 20 20 20 20 20 7d 0a 20 20 20 20 20 20 | }. |
00003cb0 7d 0a 20 20 20 20 7d 0a 20 20 20 20 64 20 3d 20 |}. }. d = |
00003cc0 6d 61 67 6e 69 74 75 64 65 28 76 78 2c 76 79 29 |magnitude(vx,vy)|
00003cd0 3b 0a 20 20 20 20 69 66 20 28 64 3c 67 2a 6f 6e |;. if (d<g*on|
00003ce0 65 29 20 7b 0a 20 20 20 20 20 20 76 78 20 3d 20 |e) {. vx = |
00003cf0 64 69 76 5f 66 72 61 63 31 36 28 76 78 2a 67 2c |div_frac16(vx*g,|
00003d00 64 29 3b 0a 20 20 20 20 20 20 76 79 20 3d 20 64 |d);. vy = d|
00003d10 69 76 5f 66 72 61 63 31 36 28 76 79 2a 67 2c 64 |iv_frac16(vy*g,d|
00003d20 29 3b 0a 20 20 20 20 20 20 64 20 20 3d 20 67 2a |);. d = g*|
00003d30 6f 6e 65 3b 0a 20 20 20 20 7d 0a 20 20 20 20 62 |one;. }. b|
00003d40 6f 69 64 5b 69 5d 2e 78 6e 20 3d 20 62 6f 69 64 |oid[i].xn = boid|
00003d50 5b 69 5d 2e 78 2b 76 78 3b 0a 20 20 20 20 62 6f |[i].x+vx;. bo|
00003d60 69 64 5b 69 5d 2e 79 6e 20 3d 20 62 6f 69 64 5b |id[i].yn = boid[|
00003d70 69 5d 2e 79 2b 76 79 3b 0a 20 20 20 20 62 6f 69 |i].y+vy;. boi|
00003d80 64 5b 69 5d 2e 76 78 20 3d 20 76 78 3b 0a 20 20 |d[i].vx = vx;. |
00003d90 20 20 62 6f 69 64 5b 69 5d 2e 76 79 20 3d 20 76 | boid[i].vy = v|
00003da0 79 3b 0a 20 20 20 20 62 6f 69 64 5b 69 5d 2e 6d |y;. boid[i].m|
00003db0 76 20 3d 20 64 3b 0a 20 20 7d 0a 20 20 66 6f 72 |v = d;. }. for|
00003dc0 20 28 69 3d 30 3b 20 69 3c 6e 3b 20 69 2b 2b 29 | (i=0; i<n; i++)|
00003dd0 20 7b 0a 20 20 20 20 62 6f 69 64 5b 69 5d 2e 78 | {. boid[i].x|
00003de0 20 3d 20 62 6f 69 64 5b 69 5d 2e 78 6e 3b 0a 20 | = boid[i].xn;. |
00003df0 20 20 20 62 6f 69 64 5b 69 5d 2e 79 20 3d 20 62 | boid[i].y = b|
00003e00 6f 69 64 5b 69 5d 2e 79 6e 3b 0a 20 20 7d 0a 7d |oid[i].yn;. }.}|
00003e10 0a 0a 69 6e 74 20 6d 61 69 6e 28 76 6f 69 64 29 |..int main(void)|
00003e20 0a 7b 0a 20 20 69 6e 74 20 69 3b 0a 20 20 69 66 |.{. int i;. if|
00003e30 20 28 21 69 6e 69 74 28 29 29 20 72 65 74 75 72 | (!init()) retur|
00003e40 6e 20 30 3b 0a 20 20 66 6f 72 20 28 73 69 6e 67 |n 0;. for (sing|
00003e50 6c 65 5f 73 74 65 70 3d 46 41 4c 53 45 3b 3b 29 |le_step=FALSE;;)|
00003e60 20 7b 0a 20 20 20 20 74 74 6f 74 61 6c 3d 63 6c | {. ttotal=cl|
00003e70 6f 63 6b 28 29 3b 0a 20 20 20 20 62 62 63 5f 63 |ock();. bbc_c|
00003e80 6c 73 28 29 3b 0a 20 20 20 20 6d 6f 76 65 5f 62 |ls();. move_b|
00003e90 6f 69 64 73 28 29 3b 0a 20 20 20 20 63 68 65 63 |oids();. chec|
00003ea0 6b 5f 6d 6f 75 73 65 28 29 3b 0a 20 20 20 20 66 |k_mouse();. f|
00003eb0 6f 72 20 28 69 3d 30 3b 20 69 3c 6e 3b 20 69 2b |or (i=0; i<n; i+|
00003ec0 2b 29 20 7b 0a 20 20 20 20 20 20 62 62 63 5f 6d |+) {. bbc_m|
00003ed0 6f 76 65 28 62 6f 69 64 5b 69 5d 2e 78 2f 6f 6e |ove(boid[i].x/on|
00003ee0 65 2c 20 62 6f 69 64 5b 69 5d 2e 79 2f 6f 6e 65 |e, boid[i].y/one|
00003ef0 29 3b 0a 20 20 20 20 20 20 62 62 63 5f 64 72 61 |);. bbc_dra|
00003f00 77 62 79 28 28 62 6f 69 64 5b 69 5d 2e 76 78 2a |wby((boid[i].vx*|
00003f10 32 2a 67 29 2f 62 6f 69 64 5b 69 5d 2e 6d 76 2c |2*g)/boid[i].mv,|
00003f20 20 28 62 6f 69 64 5b 69 5d 2e 76 79 2a 32 2a 67 | (boid[i].vy*2*g|
00003f30 29 2f 62 6f 69 64 5b 69 5d 2e 6d 76 29 3b 0a 20 |)/boid[i].mv);. |
00003f40 20 20 20 7d 0a 20 20 20 20 66 6f 72 20 28 69 3d | }. for (i=|
00003f50 30 3b 20 69 3c 70 6e 3b 20 69 2b 2b 29 20 62 62 |0; i<pn; i++) bb|
00003f60 63 5f 63 69 72 63 6c 65 28 70 69 6c 6c 61 72 5b |c_circle(pillar[|
00003f70 69 5d 2e 78 2f 6f 6e 65 2c 20 70 69 6c 6c 61 72 |i].x/one, pillar|
00003f80 5b 69 5d 2e 79 2f 6f 6e 65 2c 20 70 69 6c 6c 61 |[i].y/one, pilla|
00003f90 72 5b 69 5d 2e 72 2f 6f 6e 65 29 3b 0a 20 20 20 |r[i].r/one);. |
00003fa0 20 74 74 6f 74 61 6c 3d 63 6c 6f 63 6b 28 29 2d | ttotal=clock()-|
00003fb0 74 74 6f 74 61 6c 3b 0a 20 20 20 20 70 72 69 6e |ttotal;. prin|
00003fc0 74 66 28 22 25 69 5c 6e 25 69 5c 6e 22 2c 74 6e |tf("%i\n%i\n",tn|
00003fd0 32 2c 74 74 6f 74 61 6c 29 3b 0a 20 20 20 20 6f |2,ttotal);. o|
00003fe0 73 5f 73 77 69 31 28 4f 53 5f 42 79 74 65 2c 20 |s_swi1(OS_Byte, |
00003ff0 31 39 29 3b 0a 20 20 20 20 73 77 61 70 5f 62 61 |19);. swap_ba|
00004000 6e 6b 73 28 29 3b 0a 20 20 20 20 73 74 65 70 28 |nks();. step(|
00004010 29 3b 0a 20 20 20 20 69 66 20 28 6b 62 68 69 74 |);. if (kbhit|
00004020 28 29 29 0a 20 20 20 20 20 20 69 66 20 28 21 69 |()). if (!i|
00004030 6e 69 74 28 29 29 20 62 72 65 61 6b 3b 0a 20 20 |nit()) break;. |
00004040 7d 0a 20 20 72 65 74 75 72 6e 20 30 3b 0a 7d 0a |}. return 0;.}.|
00004050 
.