Home » Recent acquisitions » Acorn ADFS disks » adfs_ArchimedesWorld_15_03.adf » !AcornAns_AcornAns » Flocking/C/c/main
Flocking/C/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 » Recent acquisitions » Acorn ADFS disks » adfs_ArchimedesWorld_15_03.adf » !AcornAns_AcornAns |
| Filename: | Flocking/C/c/main |
| Read OK: | ✔ |
| File size: | 252A 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 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 {
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*/
int dummy15, dummy16; /*pad size to a power of 2*/
} boid_data;
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 void n2loop(void);
/*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;
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;
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 (2 to 100s depending on ARM, suggest 31+) ");
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=40*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 (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;
}
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);
}
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;
}
}
void move_boids(void)
{
int i, j, d;
int x, y, vx, vy;
int a, b;
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();
n2loop();
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;
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;
if (bbc_inkey(-36)) 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 61 62 73 28 61 |e).#define abs(a|
00000140 29 20 28 28 61 29 3c 30 20 3f 20 2d 28 61 29 20 |) ((a)<0 ? -(a) |
00000150 3a 20 28 61 29 29 0a 74 79 70 65 64 65 66 20 65 |: (a)).typedef e|
00000160 6e 75 6d 20 7b 6d 75 6c 74 69 2c 20 6e 6f 6e 6d |num {multi, nonm|
00000170 75 6c 74 69 7d 20 6d 6f 6e 69 74 6f 72 3b 0a 0a |ulti} monitor;..|
00000180 23 64 65 66 69 6e 65 20 77 65 72 72 74 65 72 6d |#define werrterm|
00000190 20 30 0a 09 09 09 09 2f 2a 70 72 69 6e 63 69 70 | 0...../*princip|
000001a0 61 6c 20 71 75 61 6e 74 69 74 69 65 73 20 75 6e |al quantities un|
000001b0 62 72 61 63 6b 65 74 65 64 2c 20 64 65 72 69 76 |bracketed, deriv|
000001c0 65 64 20 71 75 61 6e 74 69 74 69 65 73 20 62 72 |ed quantities br|
000001d0 61 63 6b 65 74 65 64 3a 2a 2f 0a 74 79 70 65 64 |acketed:*/.typed|
000001e0 65 66 20 73 74 72 75 63 74 20 7b 0a 20 20 69 6e |ef struct {. in|
000001f0 74 20 78 2c 20 79 2c 20 72 2c 20 72 32 3b 09 09 |t x, y, r, r2;..|
00000200 2f 2a 70 6f 73 69 74 69 6f 6e 2c 20 72 61 64 69 |/*position, radi|
00000210 75 73 20 28 26 20 72 61 64 69 75 73 20 73 71 75 |us (& radius squ|
00000220 61 72 65 64 29 2a 2f 0a 7d 20 70 69 6c 6c 61 72 |ared)*/.} pillar|
00000230 5f 64 61 74 61 3b 0a 0a 74 79 70 65 64 65 66 20 |_data;..typedef |
00000240 73 74 72 75 63 74 20 7b 0a 20 20 69 6e 74 20 78 |struct {. int x|
00000250 2c 20 79 2c 20 78 6e 2c 20 79 6e 3b 09 09 2f 2a |, y, xn, yn;../*|
00000260 70 6f 73 69 74 69 6f 6e 20 28 26 20 6e 65 77 20 |position (& new |
00000270 70 6f 73 69 74 69 6f 6e 29 2a 2f 0a 20 20 69 6e |position)*/. in|
00000280 74 20 76 78 2c 20 76 79 2c 20 6d 76 3b 09 09 2f |t vx, vy, mv;../|
00000290 2a 76 65 6c 6f 63 69 74 79 20 28 26 20 73 70 65 |*velocity (& spe|
000002a0 65 64 29 2a 2f 0a 20 20 69 6e 74 20 64 6d 2c 20 |ed)*/. int dm, |
000002b0 69 6d 3b 09 09 09 2f 2a 64 69 73 74 61 6e 63 65 |im;.../*distance|
000002c0 20 73 71 75 61 72 65 64 20 74 6f 20 6e 65 61 72 | squared to near|
000002d0 65 73 74 20 62 6f 69 64 20 26 20 69 6e 64 65 78 |est boid & index|
000002e0 20 6f 66 20 74 68 61 74 20 62 6f 69 64 2a 2f 0a | of that boid*/.|
000002f0 20 20 69 6e 74 20 61 78 2c 20 61 79 2c 20 61 76 | int ax, ay, av|
00000300 78 2c 20 61 76 79 2c 20 61 63 3b 09 2f 2a 61 63 |x, avy, ac;./*ac|
00000310 63 75 6d 75 6c 61 74 65 64 20 72 65 6c 61 74 69 |cumulated relati|
00000320 76 65 2d 70 6f 73 69 74 69 6f 6e 73 2f 76 65 6c |ve-positions/vel|
00000330 6f 63 69 74 69 65 73 20 6f 66 20 62 6f 69 64 73 |ocities of boids|
00000340 20 69 6e 20 6c 6f 63 61 6c 65 20 26 20 6e 75 6d | in locale & num|
00000350 62 65 72 20 6f 66 20 73 75 63 68 2a 2f 0a 20 20 |ber of such*/. |
00000360 69 6e 74 20 64 75 6d 6d 79 31 35 2c 20 64 75 6d |int dummy15, dum|
00000370 6d 79 31 36 3b 09 09 2f 2a 70 61 64 20 73 69 7a |my16;../*pad siz|
00000380 65 20 74 6f 20 61 20 70 6f 77 65 72 20 6f 66 20 |e to a power of |
00000390 32 2a 2f 0a 7d 20 62 6f 69 64 5f 64 61 74 61 3b |2*/.} boid_data;|
000003a0 0a 0a 65 78 74 65 72 6e 20 69 6e 74 20 72 62 62 |..extern int rbb|
000003b0 63 69 6e 63 28 69 6e 74 20 72 2c 20 69 6e 74 20 |cinc(int r, int |
000003c0 6b 29 3b 0a 65 78 74 65 72 6e 20 69 6e 74 20 64 |k);.extern int d|
000003d0 69 76 5f 66 72 61 63 31 36 28 69 6e 74 20 6e 75 |iv_frac16(int nu|
000003e0 6d 62 65 72 2c 20 69 6e 74 20 64 69 76 69 73 6f |mber, int diviso|
000003f0 72 29 3b 0a 65 78 74 65 72 6e 20 69 6e 74 20 6d |r);.extern int m|
00000400 75 6c 5f 66 72 61 63 31 36 28 69 6e 74 20 78 2c |ul_frac16(int x,|
00000410 20 69 6e 74 20 61 29 3b 0a 65 78 74 65 72 6e 20 | int a);.extern |
00000420 69 6e 74 20 6d 75 6c 5f 66 72 61 63 31 36 63 28 |int mul_frac16c(|
00000430 69 6e 74 20 78 2c 20 69 6e 74 20 61 29 3b 0a 65 |int x, int a);.e|
00000440 78 74 65 72 6e 20 69 6e 74 20 73 71 72 74 5f 66 |xtern int sqrt_f|
00000450 72 61 63 31 36 28 75 6e 73 69 67 6e 65 64 20 69 |rac16(unsigned i|
00000460 6e 74 20 78 29 3b 0a 65 78 74 65 72 6e 20 69 6e |nt x);.extern in|
00000470 74 20 67 61 75 73 73 31 36 28 76 6f 69 64 29 3b |t gauss16(void);|
00000480 0a 65 78 74 65 72 6e 20 76 6f 69 64 20 73 67 61 |.extern void sga|
00000490 75 73 73 31 36 28 69 6e 74 20 73 65 65 64 29 3b |uss16(int seed);|
000004a0 0a 65 78 74 65 72 6e 20 69 6e 74 20 72 61 6e 64 |.extern int rand|
000004b0 31 36 28 76 6f 69 64 29 3b 0a 65 78 74 65 72 6e |16(void);.extern|
000004c0 20 69 6e 74 20 72 61 6e 64 75 31 36 28 76 6f 69 | int randu16(voi|
000004d0 64 29 3b 0a 65 78 74 65 72 6e 20 76 6f 69 64 20 |d);.extern void |
000004e0 73 72 61 6e 64 31 36 28 69 6e 74 20 73 65 65 64 |srand16(int seed|
000004f0 29 3b 0a 65 78 74 65 72 6e 20 69 6e 74 20 63 6f |);.extern int co|
00000500 73 31 36 28 69 6e 74 20 61 29 3b 0a 65 78 74 65 |s16(int a);.exte|
00000510 72 6e 20 69 6e 74 20 73 69 6e 31 36 28 69 6e 74 |rn int sin16(int|
00000520 20 61 29 3b 0a 65 78 74 65 72 6e 20 69 6e 74 20 | a);.extern int |
00000530 65 78 70 31 36 28 69 6e 74 20 61 29 3b 0a 65 78 |exp16(int a);.ex|
00000540 74 65 72 6e 20 69 6e 74 20 6c 6e 31 36 28 69 6e |tern int ln16(in|
00000550 74 20 61 29 3b 0a 65 78 74 65 72 6e 20 69 6e 74 |t a);.extern int|
00000560 20 70 6f 77 31 36 28 69 6e 74 20 61 2c 20 69 6e | pow16(int a, in|
00000570 74 20 62 29 3b 0a 65 78 74 65 72 6e 20 69 6e 74 |t b);.extern int|
00000580 20 61 63 73 31 36 28 69 6e 74 20 61 29 3b 0a 65 | acs16(int a);.e|
00000590 78 74 65 72 6e 20 69 6e 74 20 61 73 6e 31 36 28 |xtern int asn16(|
000005a0 69 6e 74 20 61 29 3b 0a 65 78 74 65 72 6e 20 69 |int a);.extern i|
000005b0 6e 74 20 73 69 67 31 36 28 69 6e 74 20 61 29 3b |nt sig16(int a);|
000005c0 0a 0a 65 78 74 65 72 6e 20 76 6f 69 64 20 6e 32 |..extern void n2|
000005d0 6c 6f 6f 70 28 76 6f 69 64 29 3b 0a 0a 2f 2a 6d |loop(void);../*m|
000005e0 75 6c 74 69 70 6c 69 65 73 20 74 77 6f 20 31 36 |ultiplies two 16|
000005f0 20 62 69 74 20 66 69 78 65 64 20 70 6f 69 6e 74 | bit fixed point|
00000600 20 6e 75 6d 62 65 72 73 2c 20 72 65 74 75 72 6e | numbers, return|
00000610 69 6e 67 20 61 20 31 30 20 62 69 74 20 66 69 78 |ing a 10 bit fix|
00000620 65 64 20 70 6f 69 6e 74 20 6e 75 6d 62 65 72 2c |ed point number,|
00000630 20 68 65 6e 63 65 20 63 61 6e 20 72 65 70 72 65 | hence can repre|
00000640 73 65 6e 74 0a 20 20 6e 75 6d 62 65 72 73 20 75 |sent. numbers u|
00000650 70 74 6f 20 31 34 34 38 2a 31 34 34 38 20 65 67 |pto 1448*1448 eg|
00000660 20 72 65 73 75 6c 74 20 6f 66 20 6d 75 6c 31 36 | result of mul16|
00000670 31 30 28 31 34 34 38 2a 6f 6e 65 2c 31 34 34 38 |10(1448*one,1448|
00000680 2a 6f 6e 65 29 3b 0a 20 20 75 73 65 66 75 6c 20 |*one);. useful |
00000690 66 6f 72 20 61 72 69 74 68 6d 65 74 69 63 20 77 |for arithmetic w|
000006a0 69 74 68 20 73 71 75 61 72 65 73 20 6f 66 20 70 |ith squares of p|
000006b0 6f 73 69 74 69 6f 6e 73 20 6f 72 20 76 65 6c 6f |ositions or velo|
000006c0 63 69 74 69 65 73 2a 2f 0a 23 64 65 66 69 6e 65 |cities*/.#define|
000006d0 20 6d 75 6c 31 36 31 30 28 61 2c 62 29 20 28 6d | mul1610(a,b) (m|
000006e0 75 6c 5f 66 72 61 63 31 36 28 28 61 29 2f 38 2c |ul_frac16((a)/8,|
000006f0 28 62 29 2f 38 29 29 0a 2f 2a 72 65 74 75 72 6e |(b)/8))./*return|
00000700 73 20 31 36 20 62 66 70 20 73 71 75 61 72 65 20 |s 16 bfp square |
00000710 72 6f 6f 74 20 6f 66 20 31 30 20 62 66 70 20 61 |root of 10 bfp a|
00000720 72 67 75 6d 65 6e 74 2a 2f 0a 23 64 65 66 69 6e |rgument*/.#defin|
00000730 65 20 73 71 72 74 31 30 31 36 28 61 29 20 28 38 |e sqrt1016(a) (8|
00000740 2a 73 71 72 74 5f 66 72 61 63 31 36 28 28 61 29 |*sqrt_frac16((a)|
00000750 29 29 0a 0a 42 4f 4f 4c 20 76 67 61 3b 0a 69 6e |))..BOOL vga;.in|
00000760 74 20 6d 6f 64 65 3b 0a 69 6e 74 20 62 61 6e 6b |t mode;.int bank|
00000770 3b 0a 42 4f 4f 4c 20 73 69 6e 67 6c 65 5f 73 74 |;.BOOL single_st|
00000780 65 70 3b 0a 69 6e 74 20 74 6e 32 2c 20 74 74 6f |ep;.int tn2, tto|
00000790 74 61 6c 3b 0a 0a 69 6e 74 20 6e 2c 20 67 3b 0a |tal;..int n, g;.|
000007a0 69 6e 74 20 72 63 2c 20 72 6d 2c 20 72 6c 2c 20 |int rc, rm, rl, |
000007b0 72 63 32 2c 20 72 6c 32 3b 0a 69 6e 74 20 70 6e |rc2, rl2;.int pn|
000007c0 2c 20 6d 63 3b 0a 70 69 6c 6c 61 72 5f 64 61 74 |, mc;.pillar_dat|
000007d0 61 20 2a 70 69 6c 6c 61 72 3d 30 3b 0a 62 6f 69 |a *pillar=0;.boi|
000007e0 64 5f 64 61 74 61 20 2a 62 6f 69 64 3d 30 3b 0a |d_data *boid=0;.|
000007f0 0a 6d 6f 6e 69 74 6f 72 20 72 65 61 64 5f 6d 6f |.monitor read_mo|
00000800 6e 69 74 6f 72 5f 74 79 70 65 28 76 6f 69 64 29 |nitor_type(void)|
00000810 0a 7b 0a 20 20 69 6e 74 20 72 32 3b 0a 20 20 6f |.{. int r2;. o|
00000820 73 5f 73 77 69 33 72 28 36 2c 20 31 36 31 2c 31 |s_swi3r(6, 161,1|
00000830 33 33 2c 30 2c 20 30 2c 30 2c 26 72 32 29 3b 0a |33,0, 0,0,&r2);.|
00000840 20 20 69 66 20 28 28 72 32 2f 34 20 26 20 33 29 | if ((r2/4 & 3)|
00000850 20 3d 3d 20 31 29 20 72 65 74 75 72 6e 20 6d 75 | == 1) return mu|
00000860 6c 74 69 3b 0a 20 20 65 6c 73 65 20 72 65 74 75 |lti;. else retu|
00000870 72 6e 20 6e 6f 6e 6d 75 6c 74 69 3b 0a 7d 0a 0a |rn nonmulti;.}..|
00000880 76 6f 69 64 20 74 69 64 79 28 76 6f 69 64 29 0a |void tidy(void).|
00000890 7b 0a 20 20 6f 73 5f 73 77 69 32 28 4f 53 5f 42 |{. os_swi2(OS_B|
000008a0 79 74 65 2c 20 31 31 32 2c 20 31 29 3b 0a 20 20 |yte, 112, 1);. |
000008b0 6f 73 5f 73 77 69 32 28 4f 53 5f 42 79 74 65 2c |os_swi2(OS_Byte,|
000008c0 20 31 31 33 2c 20 31 29 3b 0a 7d 0a 0a 76 6f 69 | 113, 1);.}..voi|
000008d0 64 20 73 77 61 70 5f 62 61 6e 6b 73 28 76 6f 69 |d swap_banks(voi|
000008e0 64 29 0a 7b 0a 20 20 6f 73 5f 73 77 69 32 28 4f |d).{. os_swi2(O|
000008f0 53 5f 42 79 74 65 2c 20 31 31 33 2c 20 62 61 6e |S_Byte, 113, ban|
00000900 6b 29 3b 0a 20 20 6f 73 5f 73 77 69 32 28 4f 53 |k);. os_swi2(OS|
00000910 5f 42 79 74 65 2c 20 31 31 32 2c 20 62 61 6e 6b |_Byte, 112, bank|
00000920 3d 33 2d 62 61 6e 6b 29 3b 0a 7d 0a 0a 76 6f 69 |=3-bank);.}..voi|
00000930 64 20 70 72 65 70 61 72 65 5f 73 63 72 65 65 6e |d prepare_screen|
00000940 28 76 6f 69 64 29 0a 7b 0a 20 20 62 61 6e 6b 3d |(void).{. bank=|
00000950 31 3b 0a 20 20 6f 73 5f 73 77 69 32 28 4f 53 5f |1;. os_swi2(OS_|
00000960 42 79 74 65 2c 20 31 31 32 2c 20 62 61 6e 6b 29 |Byte, 112, bank)|
00000970 3b 0a 20 20 6f 73 5f 73 77 69 32 28 4f 53 5f 42 |;. os_swi2(OS_B|
00000980 79 74 65 2c 20 31 31 33 2c 20 33 2d 62 61 6e 6b |yte, 113, 3-bank|
00000990 29 3b 0a 7d 0a 0a 76 6f 69 64 20 70 72 65 73 73 |);.}..void press|
000009a0 28 69 6e 74 20 69 29 0a 7b 0a 20 20 66 6f 72 20 |(int i).{. for |
000009b0 28 3b 62 62 63 5f 69 6e 6b 65 79 28 69 29 21 3d |(;bbc_inkey(i)!=|
000009c0 2d 31 3b 29 3b 0a 20 20 72 65 74 75 72 6e 3b 0a |-1;);. return;.|
000009d0 7d 0a 0a 76 6f 69 64 20 72 65 6c 65 61 73 65 28 |}..void release(|
000009e0 69 6e 74 20 69 29 0a 7b 0a 20 20 66 6f 72 20 28 |int i).{. for (|
000009f0 3b 62 62 63 5f 69 6e 6b 65 79 28 69 29 21 3d 30 |;bbc_inkey(i)!=0|
00000a00 3b 29 3b 0a 20 20 72 65 74 75 72 6e 3b 0a 7d 0a |;);. return;.}.|
00000a10 0a 42 4f 4f 4c 20 6b 62 68 69 74 28 76 6f 69 64 |.BOOL kbhit(void|
00000a20 29 0a 7b 0a 20 20 72 65 74 75 72 6e 20 62 62 63 |).{. return bbc|
00000a30 5f 69 6e 6b 65 79 28 2d 39 39 29 3d 3d 2d 31 3b |_inkey(-99)==-1;|
00000a40 0a 7d 0a 0a 76 6f 69 64 20 73 74 65 70 28 76 6f |.}..void step(vo|
00000a50 69 64 29 0a 7b 0a 20 20 69 66 20 28 62 62 63 5f |id).{. if (bbc_|
00000a60 69 6e 6b 65 79 28 2d 38 32 29 29 20 73 69 6e 67 |inkey(-82)) sing|
00000a70 6c 65 5f 73 74 65 70 3d 54 52 55 45 3b 0a 20 20 |le_step=TRUE;. |
00000a80 69 66 20 28 73 69 6e 67 6c 65 5f 73 74 65 70 29 |if (single_step)|
00000a90 20 66 6f 72 20 28 3b 20 73 69 6e 67 6c 65 5f 73 | for (; single_s|
00000aa0 74 65 70 3b 29 20 7b 0a 20 20 20 20 69 66 20 28 |tep;) {. if (|
00000ab0 62 62 63 5f 69 6e 6b 65 79 28 2d 38 32 29 29 20 |bbc_inkey(-82)) |
00000ac0 7b 0a 20 20 20 20 20 20 72 65 6c 65 61 73 65 28 |{. release(|
00000ad0 2d 38 32 29 3b 0a 20 20 20 20 20 20 62 72 65 61 |-82);. brea|
00000ae0 6b 3b 0a 20 20 20 20 7d 0a 20 20 20 20 69 66 20 |k;. }. if |
00000af0 28 62 62 63 5f 69 6e 6b 65 79 28 2d 38 33 29 29 |(bbc_inkey(-83))|
00000b00 20 73 69 6e 67 6c 65 5f 73 74 65 70 3d 46 41 4c | single_step=FAL|
00000b10 53 45 3b 0a 20 20 7d 0a 7d 0a 0a 76 6f 69 64 20 |SE;. }.}..void |
00000b20 73 65 65 64 5f 72 61 6e 64 31 36 28 76 6f 69 64 |seed_rand16(void|
00000b30 29 0a 7b 0a 20 20 69 6e 74 20 76 3d 63 6c 6f 63 |).{. int v=cloc|
00000b40 6b 28 29 20 26 20 30 78 66 66 3b 0a 20 20 76 7c |k() & 0xff;. v||
00000b50 3d 76 3c 3c 38 3b 0a 20 20 73 72 61 6e 64 31 36 |=v<<8;. srand16|
00000b60 28 76 20 7c 20 76 3c 3c 31 36 29 3b 0a 7d 0a 0a |(v | v<<16);.}..|
00000b70 2f 2a 72 65 74 75 72 6e 73 20 31 36 62 66 70 20 |/*returns 16bfp |
00000b80 6d 61 67 6e 69 74 75 64 65 20 6f 66 20 76 65 63 |magnitude of vec|
00000b90 74 6f 72 20 77 69 74 68 20 31 36 62 66 70 20 63 |tor with 16bfp c|
00000ba0 6f 6d 70 6f 6e 65 6e 74 73 20 78 20 26 20 79 2a |omponents x & y*|
00000bb0 2f 0a 69 6e 74 20 6d 61 67 6e 69 74 75 64 65 28 |/.int magnitude(|
00000bc0 69 6e 74 20 78 2c 20 69 6e 74 20 79 29 0a 7b 0a |int x, int y).{.|
00000bd0 20 20 69 6e 74 20 66 20 3d 20 73 71 72 74 31 30 | int f = sqrt10|
00000be0 31 36 28 6d 75 6c 31 36 31 30 28 78 2c 78 29 2b |16(mul1610(x,x)+|
00000bf0 6d 75 6c 31 36 31 30 28 79 2c 79 29 29 3b 0a 20 |mul1610(y,y));. |
00000c00 20 69 66 20 28 66 3c 61 62 73 28 78 29 29 20 66 | if (f<abs(x)) f|
00000c10 3d 61 62 73 28 78 29 3b 09 2f 2a 63 6f 6d 70 65 |=abs(x);./*compe|
00000c20 6e 73 61 74 65 20 66 6f 72 20 73 6f 6d 65 20 6e |nsate for some n|
00000c30 61 73 74 79 20 75 6e 64 65 72 66 6c 6f 77 20 70 |asty underflow p|
00000c40 72 6f 62 6c 65 6d 73 2a 2f 0a 20 20 69 66 20 28 |roblems*/. if (|
00000c50 66 3c 61 62 73 28 79 29 29 20 66 3d 61 62 73 28 |f<abs(y)) f=abs(|
00000c60 79 29 3b 09 2f 2a 77 69 74 68 20 61 62 6f 76 65 |y);./*with above|
00000c70 20 66 69 78 65 64 20 70 6f 69 6e 74 20 61 72 69 | fixed point ari|
00000c80 74 68 6d 65 74 69 63 2a 2f 0a 20 20 72 65 74 75 |thmetic*/. retu|
00000c90 72 6e 20 66 3c 6f 6e 65 2f 32 35 36 20 3f 20 6f |rn f<one/256 ? o|
00000ca0 6e 65 2f 32 35 36 20 3a 20 66 3b 0a 7d 0a 0a 69 |ne/256 : f;.}..i|
00000cb0 6e 74 20 6e 65 61 72 65 73 74 73 5f 73 71 72 74 |nt nearests_sqrt|
00000cc0 28 69 6e 74 20 69 29 0a 7b 0a 20 20 69 6e 74 20 |(int i).{. int |
00000cd0 66 20 3d 20 73 71 72 74 31 30 31 36 28 62 6f 69 |f = sqrt1016(boi|
00000ce0 64 5b 69 5d 2e 64 6d 29 3b 0a 20 20 69 66 20 28 |d[i].dm);. if (|
00000cf0 66 3c 61 62 73 28 62 6f 69 64 5b 62 6f 69 64 5b |f<abs(boid[boid[|
00000d00 69 5d 2e 69 6d 5d 2e 78 2d 62 6f 69 64 5b 69 5d |i].im].x-boid[i]|
00000d10 2e 78 29 29 20 66 3d 61 62 73 28 62 6f 69 64 5b |.x)) f=abs(boid[|
00000d20 62 6f 69 64 5b 69 5d 2e 69 6d 5d 2e 78 2d 62 6f |boid[i].im].x-bo|
00000d30 69 64 5b 69 5d 2e 78 29 3b 0a 20 20 69 66 20 28 |id[i].x);. if (|
00000d40 66 3c 61 62 73 28 62 6f 69 64 5b 62 6f 69 64 5b |f<abs(boid[boid[|
00000d50 69 5d 2e 69 6d 5d 2e 79 2d 62 6f 69 64 5b 69 5d |i].im].y-boid[i]|
00000d60 2e 79 29 29 20 66 3d 61 62 73 28 62 6f 69 64 5b |.y)) f=abs(boid[|
00000d70 62 6f 69 64 5b 69 5d 2e 69 6d 5d 2e 79 2d 62 6f |boid[i].im].y-bo|
00000d80 69 64 5b 69 5d 2e 79 29 3b 0a 20 20 72 65 74 75 |id[i].y);. retu|
00000d90 72 6e 20 66 3c 6f 6e 65 2f 32 35 36 20 3f 20 6f |rn f<one/256 ? o|
00000da0 6e 65 2f 32 35 36 20 3a 20 66 3b 0a 7d 0a 0a 2f |ne/256 : f;.}../|
00000db0 2a 27 62 6f 75 6e 63 65 27 20 76 65 6c 6f 63 69 |*'bounce' veloci|
00000dc0 74 79 20 76 69 61 20 61 70 70 72 6f 61 63 68 20 |ty via approach |
00000dd0 76 65 63 74 6f 72 2c 20 6e 62 20 78 2c 79 2c 76 |vector, nb x,y,v|
00000de0 78 2c 76 79 20 31 36 62 66 70 2c 20 77 68 69 6c |x,vy 16bfp, whil|
00000df0 65 20 6d 3d 78 2a 78 2b 79 2a 79 20 31 30 62 66 |e m=x*x+y*y 10bf|
00000e00 70 2a 2f 0a 76 6f 69 64 20 62 6f 75 6e 63 65 28 |p*/.void bounce(|
00000e10 69 6e 74 20 78 2c 20 69 6e 74 20 79 2c 20 69 6e |int x, int y, in|
00000e20 74 20 2a 76 78 2c 20 69 6e 74 20 2a 76 79 2c 20 |t *vx, int *vy, |
00000e30 69 6e 74 20 6d 29 0a 7b 0a 20 20 69 6e 74 20 20 |int m).{. int |
00000e40 73 20 3d 20 6d 75 6c 31 36 31 30 28 78 2c 20 2a |s = mul1610(x, *|
00000e50 76 78 29 20 2b 20 6d 75 6c 31 36 31 30 28 79 2c |vx) + mul1610(y,|
00000e60 20 2a 76 79 29 3b 0a 20 20 69 66 20 28 73 3e 30 | *vy);. if (s>0|
00000e70 29 20 7b 0a 20 20 20 20 20 20 20 73 20 3d 20 32 |) {. s = 2|
00000e80 2a 64 69 76 5f 66 72 61 63 31 36 28 73 2c 20 6d |*div_frac16(s, m|
00000e90 3d 3d 30 20 3f 20 31 20 3a 20 6d 29 3b 0a 20 20 |==0 ? 1 : m);. |
00000ea0 20 20 2a 76 78 20 2d 3d 20 6d 75 6c 5f 66 72 61 | *vx -= mul_fra|
00000eb0 63 31 36 28 78 2c 20 73 29 3b 0a 20 20 20 20 2a |c16(x, s);. *|
00000ec0 76 79 20 2d 3d 20 6d 75 6c 5f 66 72 61 63 31 36 |vy -= mul_frac16|
00000ed0 28 79 2c 20 73 29 3b 0a 20 20 7d 0a 7d 0a 0a 42 |(y, s);. }.}..B|
00000ee0 4f 4f 4c 20 69 6e 69 74 28 76 6f 69 64 29 0a 7b |OOL init(void).{|
00000ef0 0a 20 20 69 6e 74 20 69 3b 0a 20 20 61 74 65 78 |. int i;. atex|
00000f00 69 74 28 74 69 64 79 29 3b 0a 20 20 76 67 61 20 |it(tidy);. vga |
00000f10 3d 20 72 65 61 64 5f 6d 6f 6e 69 74 6f 72 5f 74 |= read_monitor_t|
00000f20 79 70 65 28 29 3d 3d 6d 75 6c 74 69 20 3f 20 54 |ype()==multi ? T|
00000f30 52 55 45 20 3a 20 46 41 4c 53 45 3b 0a 20 20 6d |RUE : FALSE;. m|
00000f40 6f 64 65 20 3d 20 76 67 61 20 3f 20 31 38 20 3a |ode = vga ? 18 :|
00000f50 20 30 3b 0a 20 20 74 69 64 79 28 29 3b 0a 20 20 | 0;. tidy();. |
00000f60 62 62 63 5f 6d 6f 64 65 28 6d 6f 64 65 2b 31 32 |bbc_mode(mode+12|
00000f70 38 29 3b 0a 20 20 62 62 63 5f 6d 6f 64 65 28 6d |8);. bbc_mode(m|
00000f80 6f 64 65 29 3b 0a 20 20 62 62 63 5f 63 75 72 73 |ode);. bbc_curs|
00000f90 6f 72 28 30 29 3b 0a 20 20 6f 73 5f 63 6c 69 28 |or(0);. os_cli(|
00000fa0 22 70 6f 69 6e 74 65 72 22 29 3b 0a 20 20 62 62 |"pointer");. bb|
00000fb0 63 5f 6f 72 69 67 69 6e 28 36 34 30 2c 35 31 32 |c_origin(640,512|
00000fc0 29 3b 0a 20 20 70 6f 69 6e 74 65 72 5f 72 65 73 |);. pointer_res|
00000fd0 65 74 5f 73 68 61 70 65 28 29 3b 0a 20 20 72 65 |et_shape();. re|
00000fe0 6c 65 61 73 65 28 2d 39 39 29 3b 0a 20 20 6f 73 |lease(-99);. os|
00000ff0 5f 73 77 69 32 28 4f 53 5f 42 79 74 65 2c 20 31 |_swi2(OS_Byte, 1|
00001000 35 2c 20 31 29 3b 0a 20 20 64 6f 20 7b 0a 20 20 |5, 1);. do {. |
00001010 20 20 70 72 69 6e 74 66 28 22 50 6c 65 61 73 65 | printf("Please|
00001020 20 65 6e 74 65 72 20 6e 75 6d 62 65 72 20 6f 66 | enter number of|
00001030 20 62 6f 69 64 73 20 28 32 20 74 6f 20 31 30 30 | boids (2 to 100|
00001040 73 20 64 65 70 65 6e 64 69 6e 67 20 6f 6e 20 41 |s depending on A|
00001050 52 4d 2c 20 73 75 67 67 65 73 74 20 33 31 2b 29 |RM, suggest 31+)|
00001060 20 22 29 3b 0a 20 20 20 20 73 63 61 6e 66 28 22 | ");. scanf("|
00001070 25 69 22 2c 20 26 6e 29 3b 0a 20 20 7d 20 77 68 |%i", &n);. } wh|
00001080 69 6c 65 20 28 6e 3c 32 29 3b 0a 20 20 64 6f 20 |ile (n<2);. do |
00001090 7b 0a 20 20 20 20 70 72 69 6e 74 66 28 22 50 6c |{. printf("Pl|
000010a0 65 61 73 65 20 65 6e 74 65 72 20 6e 75 6d 62 65 |ease enter numbe|
000010b0 72 20 6f 66 20 70 69 6c 6c 61 72 73 20 28 31 20 |r of pillars (1 |
000010c0 74 6f 20 31 30 30 2c 20 73 75 67 67 65 73 74 20 |to 100, suggest |
000010d0 34 29 20 22 29 3b 0a 20 20 20 20 73 63 61 6e 66 |4) ");. scanf|
000010e0 28 22 25 69 22 2c 20 26 70 6e 29 3b 0a 20 20 7d |("%i", &pn);. }|
000010f0 20 77 68 69 6c 65 20 28 70 6e 3c 31 20 7c 7c 20 | while (pn<1 || |
00001100 70 6e 3e 31 30 30 29 3b 0a 20 20 64 6f 20 7b 0a |pn>100);. do {.|
00001110 20 20 20 20 70 72 69 6e 74 66 28 22 50 6c 65 61 | printf("Plea|
00001120 73 65 20 65 6e 74 65 72 20 62 6f 69 64 20 73 69 |se enter boid si|
00001130 7a 65 20 28 31 20 74 6f 20 38 2c 20 73 75 67 67 |ze (1 to 8, sugg|
00001140 65 73 74 20 34 29 20 22 29 3b 0a 20 20 20 20 73 |est 4) ");. s|
00001150 63 61 6e 66 28 22 25 69 22 2c 20 26 67 29 3b 0a |canf("%i", &g);.|
00001160 20 20 7d 20 77 68 69 6c 65 20 28 67 3c 31 20 7c | } while (g<1 ||
00001170 7c 20 67 3e 38 29 3b 0a 20 20 64 6f 20 7b 0a 20 || g>8);. do {. |
00001180 20 20 20 70 72 69 6e 74 66 28 22 50 6c 65 61 73 | printf("Pleas|
00001190 65 20 65 6e 74 65 72 20 73 65 65 64 20 66 6f 72 |e enter seed for|
000011a0 20 72 61 6e 64 6f 6d 20 69 6e 69 74 69 61 6c 69 | random initiali|
000011b0 73 61 74 69 6f 6e 20 28 61 6e 79 20 6e 6f 6e 2d |sation (any non-|
000011c0 7a 65 72 6f 20 69 6e 74 65 67 65 72 2c 5c 6e 6f |zero integer,\no|
000011d0 72 20 30 20 66 6f 72 20 61 20 27 72 61 6e 64 6f |r 0 for a 'rando|
000011e0 6d 27 20 73 65 65 64 3b 20 74 72 79 20 31 30 31 |m' seed; try 101|
000011f0 29 20 22 29 3b 0a 20 20 20 20 73 63 61 6e 66 28 |) ");. scanf(|
00001200 22 25 69 22 2c 20 26 69 29 3b 0a 20 20 7d 20 77 |"%i", &i);. } w|
00001210 68 69 6c 65 20 28 46 41 4c 53 45 29 3b 0a 0a 20 |hile (FALSE);.. |
00001220 20 69 66 20 28 69 29 20 73 72 61 6e 64 31 36 28 | if (i) srand16(|
00001230 7e 28 69 5e 28 69 3c 3c 31 36 29 29 29 3b 0a 20 |~(i^(i<<16)));. |
00001240 20 65 6c 73 65 20 73 65 65 64 5f 72 61 6e 64 31 | else seed_rand1|
00001250 36 28 29 3b 0a 20 20 72 63 3d 35 2a 67 2a 6f 6e |6();. rc=5*g*on|
00001260 65 3b 09 09 2f 2a 72 61 64 69 75 73 20 66 6f 72 |e;../*radius for|
00001270 20 63 6f 6c 6c 69 73 69 6f 6e 20 64 65 74 65 63 | collision detec|
00001280 74 69 6f 6e 2a 2f 0a 20 20 72 6d 3d 38 2a 67 2a |tion*/. rm=8*g*|
00001290 6f 6e 65 3b 09 09 2f 2a 72 61 64 69 75 73 20 66 |one;../*radius f|
000012a0 6f 72 20 76 65 6c 6f 63 69 74 79 20 6d 61 74 63 |or velocity matc|
000012b0 68 69 6e 67 2a 2f 0a 20 20 72 6c 3d 34 30 2a 67 |hing*/. rl=40*g|
000012c0 2a 6f 6e 65 3b 09 09 2f 2a 72 61 64 69 75 73 20 |*one;../*radius |
000012d0 6f 66 20 6c 6f 63 61 6c 65 2a 2f 0a 20 20 72 63 |of locale*/. rc|
000012e0 32 3d 6d 75 6c 31 36 31 30 28 72 63 2c 72 63 29 |2=mul1610(rc,rc)|
000012f0 3b 0a 20 20 72 6c 32 3d 6d 75 6c 31 36 31 30 28 |;. rl2=mul1610(|
00001300 72 6c 2c 72 6c 29 3b 0a 20 20 69 66 20 28 70 69 |rl,rl);. if (pi|
00001310 6c 6c 61 72 29 20 7b 0a 20 20 20 20 66 72 65 65 |llar) {. free|
00001320 28 70 69 6c 6c 61 72 29 3b 0a 20 20 20 20 70 69 |(pillar);. pi|
00001330 6c 6c 61 72 3d 30 3b 0a 20 20 7d 0a 20 20 69 66 |llar=0;. }. if|
00001340 20 28 62 6f 69 64 29 20 7b 0a 20 20 20 20 66 72 | (boid) {. fr|
00001350 65 65 28 62 6f 69 64 29 3b 0a 20 20 20 20 62 6f |ee(boid);. bo|
00001360 69 64 3d 30 3b 0a 20 20 7d 0a 20 20 69 66 20 28 |id=0;. }. if (|
00001370 70 69 6c 6c 61 72 20 3d 20 63 61 6c 6c 6f 63 28 |pillar = calloc(|
00001380 70 6e 2c 20 73 69 7a 65 6f 66 28 70 69 6c 6c 61 |pn, sizeof(pilla|
00001390 72 5f 64 61 74 61 29 29 2c 20 70 69 6c 6c 61 72 |r_data)), pillar|
000013a0 3d 3d 30 29 20 7b 0a 20 20 20 20 77 65 72 72 28 |==0) {. werr(|
000013b0 77 65 72 72 74 65 72 6d 2c 20 22 49 6e 73 75 66 |werrterm, "Insuf|
000013c0 66 69 63 69 65 6e 74 20 6d 65 6d 6f 72 79 22 29 |ficient memory")|
000013d0 3b 0a 20 20 20 20 72 65 74 75 72 6e 20 46 41 4c |;. return FAL|
000013e0 53 45 3b 0a 20 20 7d 0a 20 20 69 66 20 28 62 6f |SE;. }. if (bo|
000013f0 69 64 20 20 20 3d 20 63 61 6c 6c 6f 63 28 20 6e |id = calloc( n|
00001400 2c 20 73 69 7a 65 6f 66 28 20 20 62 6f 69 64 5f |, sizeof( boid_|
00001410 64 61 74 61 29 29 2c 20 20 20 62 6f 69 64 3d 3d |data)), boid==|
00001420 30 29 20 7b 0a 20 20 20 20 77 65 72 72 28 77 65 |0) {. werr(we|
00001430 72 72 74 65 72 6d 2c 20 22 49 6e 73 75 66 66 69 |rrterm, "Insuffi|
00001440 63 69 65 6e 74 20 6d 65 6d 6f 72 79 22 29 3b 0a |cient memory");.|
00001450 20 20 20 20 72 65 74 75 72 6e 20 46 41 4c 53 45 | return FALSE|
00001460 3b 0a 20 20 7d 0a 20 20 6d 63 3d 30 3b 0a 20 20 |;. }. mc=0;. |
00001470 66 6f 72 20 28 69 3d 30 3b 20 69 3c 70 6e 3b 20 |for (i=0; i<pn; |
00001480 69 2b 2b 29 20 7b 0a 20 20 20 20 70 69 6c 6c 61 |i++) {. pilla|
00001490 72 5b 69 5d 2e 78 20 20 3d 20 72 61 6e 64 31 36 |r[i].x = rand16|
000014a0 28 29 2a 36 34 30 3b 0a 20 20 20 20 70 69 6c 6c |()*640;. pill|
000014b0 61 72 5b 69 5d 2e 79 20 20 3d 20 72 61 6e 64 31 |ar[i].y = rand1|
000014c0 36 28 29 2a 35 31 32 3b 0a 20 20 20 20 70 69 6c |6()*512;. pil|
000014d0 6c 61 72 5b 69 5d 2e 72 20 20 3d 20 72 61 6e 64 |lar[i].r = rand|
000014e0 75 31 36 28 29 2a 34 30 3b 0a 20 20 20 20 70 69 |u16()*40;. pi|
000014f0 6c 6c 61 72 5b 69 5d 2e 72 32 20 3d 20 6d 75 6c |llar[i].r2 = mul|
00001500 31 36 31 30 28 70 69 6c 6c 61 72 5b 69 5d 2e 72 |1610(pillar[i].r|
00001510 2b 72 63 2f 32 2c 20 70 69 6c 6c 61 72 5b 69 5d |+rc/2, pillar[i]|
00001520 2e 72 2b 72 63 2f 32 29 3b 0a 20 20 7d 0a 20 20 |.r+rc/2);. }. |
00001530 66 6f 72 20 28 69 3d 30 3b 20 69 3c 6e 3b 20 69 |for (i=0; i<n; i|
00001540 2b 2b 29 20 7b 0a 20 20 20 20 62 6f 69 64 5b 69 |++) {. boid[i|
00001550 5d 2e 78 20 20 3d 20 36 34 2a 67 2a 72 61 6e 64 |].x = 64*g*rand|
00001560 31 36 28 29 3b 0a 20 20 20 20 62 6f 69 64 5b 69 |16();. boid[i|
00001570 5d 2e 79 20 20 3d 20 36 34 2a 67 2a 72 61 6e 64 |].y = 64*g*rand|
00001580 31 36 28 29 3b 0a 20 20 20 20 62 6f 69 64 5b 69 |16();. boid[i|
00001590 5d 2e 76 78 20 3d 20 20 34 2a 67 2a 72 61 6e 64 |].vx = 4*g*rand|
000015a0 75 31 36 28 29 3b 0a 20 20 20 20 62 6f 69 64 5b |u16();. boid[|
000015b0 69 5d 2e 76 79 20 3d 20 20 32 2a 67 2a 72 61 6e |i].vy = 2*g*ran|
000015c0 64 31 36 28 29 3b 0a 20 20 20 20 62 6f 69 64 5b |d16();. boid[|
000015d0 69 5d 2e 6d 76 20 3d 20 6d 61 67 6e 69 74 75 64 |i].mv = magnitud|
000015e0 65 28 62 6f 69 64 5b 69 5d 2e 76 78 2c 62 6f 69 |e(boid[i].vx,boi|
000015f0 64 5b 69 5d 2e 76 79 29 3b 0a 20 20 7d 0a 20 20 |d[i].vy);. }. |
00001600 70 72 65 70 61 72 65 5f 73 63 72 65 65 6e 28 29 |prepare_screen()|
00001610 3b 0a 20 20 72 65 74 75 72 6e 20 54 52 55 45 3b |;. return TRUE;|
00001620 0a 7d 0a 0a 76 6f 69 64 20 63 68 65 63 6b 5f 6d |.}..void check_m|
00001630 6f 75 73 65 28 76 6f 69 64 29 0a 7b 0a 20 20 69 |ouse(void).{. i|
00001640 6e 74 20 78 2c 79 2c 7a 2c 20 69 2c 64 3b 0a 20 |nt x,y,z, i,d;. |
00001650 20 6f 73 5f 73 77 69 33 72 28 4f 53 5f 4d 6f 75 | os_swi3r(OS_Mou|
00001660 73 65 2c 20 30 2c 30 2c 30 2c 20 26 78 2c 26 79 |se, 0,0,0, &x,&y|
00001670 2c 26 7a 29 3b 0a 20 20 78 2a 3d 6f 6e 65 3b 0a |,&z);. x*=one;.|
00001680 20 20 79 2a 3d 6f 6e 65 3b 0a 20 20 73 77 69 74 | y*=one;. swit|
00001690 63 68 28 7a 29 20 7b 0a 20 20 20 20 63 61 73 65 |ch(z) {. case|
000016a0 20 31 3a 0a 20 20 20 20 20 20 69 66 20 28 70 69 | 1:. if (pi|
000016b0 6c 6c 61 72 5b 6d 63 5d 2e 72 3e 6f 6e 65 29 20 |llar[mc].r>one) |
000016c0 7b 0a 20 20 20 20 20 20 20 20 70 69 6c 6c 61 72 |{. pillar|
000016d0 5b 6d 63 5d 2e 72 2d 3d 6f 6e 65 3b 0a 20 20 20 |[mc].r-=one;. |
000016e0 20 20 20 20 20 70 69 6c 6c 61 72 5b 6d 63 5d 2e | pillar[mc].|
000016f0 72 32 3d 6d 75 6c 31 36 31 30 28 70 69 6c 6c 61 |r2=mul1610(pilla|
00001700 72 5b 6d 63 5d 2e 72 2b 72 63 2f 32 2c 20 70 69 |r[mc].r+rc/2, pi|
00001710 6c 6c 61 72 5b 6d 63 5d 2e 72 2b 72 63 2f 32 29 |llar[mc].r+rc/2)|
00001720 3b 0a 20 20 20 20 20 20 7d 0a 20 20 20 20 20 20 |;. }. |
00001730 62 72 65 61 6b 3b 0a 20 20 20 20 63 61 73 65 20 |break;. case |
00001740 32 3a 0a 20 20 20 20 20 20 69 66 20 28 70 69 6c |2:. if (pil|
00001750 6c 61 72 5b 6d 63 5d 2e 72 3c 6f 6e 65 2a 32 30 |lar[mc].r<one*20|
00001760 30 29 20 7b 0a 20 20 20 20 20 20 20 20 70 69 6c |0) {. pil|
00001770 6c 61 72 5b 6d 63 5d 2e 72 2b 3d 6f 6e 65 3b 0a |lar[mc].r+=one;.|
00001780 20 20 20 20 20 20 20 20 70 69 6c 6c 61 72 5b 6d | pillar[m|
00001790 63 5d 2e 72 32 3d 6d 75 6c 31 36 31 30 28 70 69 |c].r2=mul1610(pi|
000017a0 6c 6c 61 72 5b 6d 63 5d 2e 72 2b 72 63 2f 32 2c |llar[mc].r+rc/2,|
000017b0 20 70 69 6c 6c 61 72 5b 6d 63 5d 2e 72 2b 72 63 | pillar[mc].r+rc|
000017c0 2f 32 29 3b 0a 20 20 20 20 20 20 7d 0a 20 20 20 |/2);. }. |
000017d0 20 20 20 62 72 65 61 6b 3b 0a 20 20 20 20 63 61 | break;. ca|
000017e0 73 65 20 34 3a 0a 20 20 20 20 20 20 66 6f 72 20 |se 4:. for |
000017f0 28 69 3d 6d 63 3b 20 69 3c 70 6e 3b 20 69 2b 2b |(i=mc; i<pn; i++|
00001800 29 20 7b 0a 20 20 20 20 20 20 20 20 69 66 20 28 |) {. if (|
00001810 61 62 73 28 70 69 6c 6c 61 72 5b 69 5d 2e 78 2d |abs(pillar[i].x-|
00001820 78 29 3c 70 69 6c 6c 61 72 5b 69 5d 2e 72 20 26 |x)<pillar[i].r &|
00001830 26 20 61 62 73 28 70 69 6c 6c 61 72 5b 69 5d 2e |& abs(pillar[i].|
00001840 79 2d 79 29 3c 70 69 6c 6c 61 72 5b 69 5d 2e 72 |y-y)<pillar[i].r|
00001850 29 20 7b 0a 20 20 20 20 20 20 20 20 20 20 64 20 |) {. d |
00001860 3d 20 6d 75 6c 31 36 31 30 28 70 69 6c 6c 61 72 |= mul1610(pillar|
00001870 5b 69 5d 2e 78 2d 78 2c 70 69 6c 6c 61 72 5b 69 |[i].x-x,pillar[i|
00001880 5d 2e 78 2d 78 29 20 2b 20 6d 75 6c 31 36 31 30 |].x-x) + mul1610|
00001890 28 70 69 6c 6c 61 72 5b 69 5d 2e 79 2d 79 2c 70 |(pillar[i].y-y,p|
000018a0 69 6c 6c 61 72 5b 69 5d 2e 79 2d 79 29 3b 0a 20 |illar[i].y-y);. |
000018b0 20 20 20 20 20 20 20 20 20 69 66 20 28 64 20 3c | if (d <|
000018c0 20 70 69 6c 6c 61 72 5b 69 5d 2e 72 32 29 20 7b | pillar[i].r2) {|
000018d0 0a 20 20 20 20 20 20 20 20 20 20 20 20 69 2b 3d |. i+=|
000018e0 30 78 31 30 30 30 30 3b 0a 20 20 20 20 20 20 20 |0x10000;. |
000018f0 20 20 20 20 20 62 72 65 61 6b 3b 0a 20 20 20 20 | break;. |
00001900 20 20 20 20 20 20 7d 0a 20 20 20 20 20 20 20 20 | }. |
00001910 7d 0a 20 20 20 20 20 20 20 20 69 66 20 28 69 3d |}. if (i=|
00001920 3d 6d 63 29 20 20 20 69 3d 2d 31 3b 0a 20 20 20 |=mc) i=-1;. |
00001930 20 20 20 20 20 69 66 20 28 69 3d 3d 6d 63 2d 31 | if (i==mc-1|
00001940 29 20 69 3d 6d 63 3b 0a 20 20 20 20 20 20 7d 0a |) i=mc;. }.|
00001950 20 20 20 20 20 20 69 66 20 28 69 26 30 78 31 30 | if (i&0x10|
00001960 30 30 30 20 26 26 20 69 21 3d 30 78 31 30 30 30 |000 && i!=0x1000|
00001970 30 2b 6d 63 29 20 7b 0a 20 20 20 20 20 20 20 20 |0+mc) {. |
00001980 6d 63 20 3d 20 69 2d 30 78 31 30 30 30 30 3b 0a |mc = i-0x10000;.|
00001990 20 20 20 20 20 20 20 20 62 62 63 5f 76 64 75 28 | bbc_vdu(|
000019a0 37 29 3b 0a 20 20 20 20 20 20 7d 0a 20 20 20 20 |7);. }. |
000019b0 20 20 65 6c 73 65 20 7b 0a 20 20 20 20 20 20 20 | else {. |
000019c0 20 70 69 6c 6c 61 72 5b 6d 63 5d 2e 78 20 3d 20 | pillar[mc].x = |
000019d0 78 3b 0a 20 20 20 20 20 20 20 20 70 69 6c 6c 61 |x;. pilla|
000019e0 72 5b 6d 63 5d 2e 79 20 3d 20 79 3b 0a 20 20 20 |r[mc].y = y;. |
000019f0 20 20 20 7d 0a 20 20 20 20 20 20 62 72 65 61 6b | }. break|
00001a00 3b 0a 20 20 7d 0a 7d 0a 0a 76 6f 69 64 20 6d 6f |;. }.}..void mo|
00001a10 76 65 5f 62 6f 69 64 73 28 76 6f 69 64 29 0a 7b |ve_boids(void).{|
00001a20 0a 20 20 69 6e 74 20 69 2c 20 6a 2c 20 64 3b 0a |. int i, j, d;.|
00001a30 20 20 69 6e 74 20 78 2c 20 79 2c 20 76 78 2c 20 | int x, y, vx, |
00001a40 76 79 3b 0a 20 20 69 6e 74 20 61 2c 20 62 3b 0a |vy;. int a, b;.|
00001a50 20 20 62 6f 69 64 5f 64 61 74 61 20 2a 62 70 2c | boid_data *bp,|
00001a60 20 2a 62 70 65 3b 0a 20 20 66 6f 72 20 28 62 70 | *bpe;. for (bp|
00001a70 3d 62 6f 69 64 2c 62 70 65 3d 62 70 2b 6e 3b 20 |=boid,bpe=bp+n; |
00001a80 62 70 3c 62 70 65 3b 20 62 70 2b 2b 29 20 7b 0a |bp<bpe; bp++) {.|
00001a90 20 20 20 20 62 70 2d 3e 64 6d 3d 30 78 37 66 66 | bp->dm=0x7ff|
00001aa0 66 66 66 66 66 3b 0a 20 20 20 20 62 70 2d 3e 61 |fffff;. bp->a|
00001ab0 78 3d 62 70 2d 3e 61 79 3d 62 70 2d 3e 61 76 78 |x=bp->ay=bp->avx|
00001ac0 3d 62 70 2d 3e 61 76 79 3d 62 70 2d 3e 61 63 3d |=bp->avy=bp->ac=|
00001ad0 30 3b 0a 20 20 7d 0a 20 20 74 6e 32 3d 63 6c 6f |0;. }. tn2=clo|
00001ae0 63 6b 28 29 3b 0a 20 20 6e 32 6c 6f 6f 70 28 29 |ck();. n2loop()|
00001af0 3b 0a 20 20 74 6e 32 3d 63 6c 6f 63 6b 28 29 2d |;. tn2=clock()-|
00001b00 74 6e 32 3b 0a 20 20 66 6f 72 20 28 69 3d 30 3b |tn2;. for (i=0;|
00001b10 20 69 3c 6e 3b 20 69 2b 2b 29 20 7b 0a 20 20 20 | i<n; i++) {. |
00001b20 20 78 20 20 3d 20 62 6f 69 64 5b 69 5d 2e 78 3b | x = boid[i].x;|
00001b30 0a 20 20 20 20 79 20 20 3d 20 62 6f 69 64 5b 69 |. y = boid[i|
00001b40 5d 2e 79 3b 0a 20 20 20 20 76 78 20 3d 20 62 6f |].y;. vx = bo|
00001b50 69 64 5b 69 5d 2e 76 78 3b 0a 20 20 20 20 76 79 |id[i].vx;. vy|
00001b60 20 3d 20 62 6f 69 64 5b 69 5d 2e 76 79 3b 0a 20 | = boid[i].vy;. |
00001b70 20 20 20 69 66 20 28 62 6f 69 64 5b 69 5d 2e 61 | if (boid[i].a|
00001b80 63 3c 31 29 20 7b 0a 20 20 20 20 20 20 6a 20 3d |c<1) {. j =|
00001b90 20 62 6f 69 64 5b 69 5d 2e 69 6d 3b 0a 20 20 20 | boid[i].im;. |
00001ba0 20 20 20 62 6f 69 64 5b 69 5d 2e 61 78 20 20 2b | boid[i].ax +|
00001bb0 3d 20 62 6f 69 64 5b 6a 5d 2e 78 2d 78 3b 0a 20 |= boid[j].x-x;. |
00001bc0 20 20 20 20 20 62 6f 69 64 5b 69 5d 2e 61 79 20 | boid[i].ay |
00001bd0 20 2b 3d 20 62 6f 69 64 5b 6a 5d 2e 79 2d 79 3b | += boid[j].y-y;|
00001be0 0a 20 20 20 20 20 20 62 6f 69 64 5b 69 5d 2e 61 |. boid[i].a|
00001bf0 76 78 20 2b 3d 20 62 6f 69 64 5b 6a 5d 2e 76 78 |vx += boid[j].vx|
00001c00 3b 0a 20 20 20 20 20 20 62 6f 69 64 5b 69 5d 2e |;. boid[i].|
00001c10 61 76 79 20 2b 3d 20 62 6f 69 64 5b 6a 5d 2e 76 |avy += boid[j].v|
00001c20 79 3b 0a 20 20 20 20 20 20 62 6f 69 64 5b 69 5d |y;. boid[i]|
00001c30 2e 61 63 20 20 2b 3d 20 31 3b 0a 20 20 20 20 7d |.ac += 1;. }|
00001c40 0a 20 20 20 20 69 66 20 28 78 3c 72 63 2d 36 34 |. if (x<rc-64|
00001c50 30 2a 6f 6e 65 20 7c 7c 20 78 3e 36 34 30 2a 6f |0*one || x>640*o|
00001c60 6e 65 2d 72 63 20 7c 7c 20 79 3c 72 63 2d 35 31 |ne-rc || y<rc-51|
00001c70 32 2a 6f 6e 65 20 7c 7c 20 79 3e 35 31 32 2a 6f |2*one || y>512*o|
00001c80 6e 65 2d 72 63 29 20 7b 0a 20 20 20 20 20 20 69 |ne-rc) {. i|
00001c90 66 20 28 78 3c 72 63 2d 36 34 30 2a 6f 6e 65 26 |f (x<rc-640*one&|
00001ca0 26 76 78 3c 30 20 7c 7c 20 78 3e 36 34 30 2a 6f |&vx<0 || x>640*o|
00001cb0 6e 65 2d 72 63 26 26 76 78 3e 30 29 20 76 78 3d |ne-rc&&vx>0) vx=|
00001cc0 2d 76 78 3b 0a 20 20 20 20 20 20 69 66 20 28 79 |-vx;. if (y|
00001cd0 3c 72 63 2d 35 31 32 2a 6f 6e 65 26 26 76 79 3c |<rc-512*one&&vy<|
00001ce0 30 20 7c 7c 20 79 3e 35 31 32 2a 6f 6e 65 2d 72 |0 || y>512*one-r|
00001cf0 63 26 26 76 79 3e 30 29 20 76 79 3d 2d 76 79 3b |c&&vy>0) vy=-vy;|
00001d00 0a 20 20 20 20 7d 0a 20 20 20 20 65 6c 73 65 20 |. }. else |
00001d10 7b 0a 20 20 20 20 20 20 66 6f 72 20 28 6a 3d 30 |{. for (j=0|
00001d20 3b 20 6a 3c 70 6e 3b 20 6a 2b 2b 29 20 7b 0a 20 |; j<pn; j++) {. |
00001d30 20 20 20 20 20 20 20 69 66 20 28 61 62 73 28 70 | if (abs(p|
00001d40 69 6c 6c 61 72 5b 6a 5d 2e 78 2d 78 29 3c 70 69 |illar[j].x-x)<pi|
00001d50 6c 6c 61 72 5b 6a 5d 2e 72 20 26 26 20 61 62 73 |llar[j].r && abs|
00001d60 28 70 69 6c 6c 61 72 5b 6a 5d 2e 79 2d 79 29 3c |(pillar[j].y-y)<|
00001d70 70 69 6c 6c 61 72 5b 6a 5d 2e 72 29 20 7b 0a 20 |pillar[j].r) {. |
00001d80 20 20 20 20 20 20 20 20 20 64 20 3d 20 6d 75 6c | d = mul|
00001d90 31 36 31 30 28 70 69 6c 6c 61 72 5b 6a 5d 2e 78 |1610(pillar[j].x|
00001da0 2d 78 2c 70 69 6c 6c 61 72 5b 6a 5d 2e 78 2d 78 |-x,pillar[j].x-x|
00001db0 29 20 2b 20 6d 75 6c 31 36 31 30 28 70 69 6c 6c |) + mul1610(pill|
00001dc0 61 72 5b 6a 5d 2e 79 2d 79 2c 70 69 6c 6c 61 72 |ar[j].y-y,pillar|
00001dd0 5b 6a 5d 2e 79 2d 79 29 3b 0a 20 20 20 20 20 20 |[j].y-y);. |
00001de0 20 20 20 20 69 66 20 28 64 20 3c 20 70 69 6c 6c | if (d < pill|
00001df0 61 72 5b 6a 5d 2e 72 32 29 20 7b 0a 20 20 20 20 |ar[j].r2) {. |
00001e00 20 20 20 20 20 20 20 20 6a 2b 3d 30 78 31 30 30 | j+=0x100|
00001e10 30 30 3b 0a 20 20 20 20 20 20 20 20 20 20 20 20 |00;. |
00001e20 62 72 65 61 6b 3b 0a 20 20 20 20 20 20 20 20 20 |break;. |
00001e30 20 7d 0a 20 20 20 20 20 20 20 20 7d 0a 20 20 20 | }. }. |
00001e40 20 20 20 7d 0a 20 20 20 20 20 20 69 66 20 28 6a | }. if (j|
00001e50 20 26 20 30 78 31 30 30 30 30 29 20 7b 0a 20 20 | & 0x10000) {. |
00001e60 20 20 20 20 20 20 6a 2d 3d 30 78 31 30 30 30 30 | j-=0x10000|
00001e70 3b 0a 20 20 20 20 20 20 20 20 62 6f 75 6e 63 65 |;. bounce|
00001e80 28 70 69 6c 6c 61 72 5b 6a 5d 2e 78 2d 78 2c 20 |(pillar[j].x-x, |
00001e90 70 69 6c 6c 61 72 5b 6a 5d 2e 79 2d 79 2c 20 26 |pillar[j].y-y, &|
00001ea0 76 78 2c 20 26 76 79 2c 20 64 29 3b 0a 20 20 20 |vx, &vy, d);. |
00001eb0 20 20 20 7d 0a 20 20 20 20 20 20 65 6c 73 65 20 | }. else |
00001ec0 69 66 20 28 62 6f 69 64 5b 69 5d 2e 64 6d 3c 72 |if (boid[i].dm<r|
00001ed0 63 32 29 20 62 6f 75 6e 63 65 28 62 6f 69 64 5b |c2) bounce(boid[|
00001ee0 62 6f 69 64 5b 69 5d 2e 69 6d 5d 2e 78 2d 78 2c |boid[i].im].x-x,|
00001ef0 20 62 6f 69 64 5b 62 6f 69 64 5b 69 5d 2e 69 6d | boid[boid[i].im|
00001f00 5d 2e 79 2d 79 2c 20 26 76 78 2c 20 26 76 79 2c |].y-y, &vx, &vy,|
00001f10 20 62 6f 69 64 5b 69 5d 2e 64 6d 29 3b 0a 20 20 | boid[i].dm);. |
00001f20 20 20 20 20 65 6c 73 65 20 7b 0a 20 20 20 20 20 | else {. |
00001f30 20 20 20 61 20 3d 20 62 6f 69 64 5b 69 5d 2e 61 | a = boid[i].a|
00001f40 78 2f 62 6f 69 64 5b 69 5d 2e 61 63 3b 0a 20 20 |x/boid[i].ac;. |
00001f50 20 20 20 20 20 20 62 20 3d 20 62 6f 69 64 5b 69 | b = boid[i|
00001f60 5d 2e 61 79 2f 62 6f 69 64 5b 69 5d 2e 61 63 3b |].ay/boid[i].ac;|
00001f70 0a 20 20 20 20 20 20 20 20 64 20 3d 20 6d 61 67 |. d = mag|
00001f80 6e 69 74 75 64 65 28 61 2c 62 29 3b 0a 20 20 20 |nitude(a,b);. |
00001f90 20 20 20 20 20 61 20 3d 20 64 69 76 5f 66 72 61 | a = div_fra|
00001fa0 63 31 36 28 61 2c 64 29 3b 0a 20 20 20 20 20 20 |c16(a,d);. |
00001fb0 20 20 62 20 3d 20 64 69 76 5f 66 72 61 63 31 36 | b = div_frac16|
00001fc0 28 62 2c 64 29 3b 0a 20 20 20 20 20 20 20 20 64 |(b,d);. d|
00001fd0 20 3d 20 6e 65 61 72 65 73 74 73 5f 73 71 72 74 | = nearests_sqrt|
00001fe0 28 69 29 3b 0a 20 20 20 20 20 20 20 20 69 66 20 |(i);. if |
00001ff0 28 64 3c 72 6d 29 20 7b 0a 20 20 20 20 20 20 20 |(d<rm) {. |
00002000 20 20 20 76 78 20 3d 20 64 69 76 5f 66 72 61 63 | vx = div_frac|
00002010 31 36 28 20 6d 75 6c 5f 66 72 61 63 31 36 28 62 |16( mul_frac16(b|
00002020 6f 69 64 5b 69 5d 2e 61 76 78 2f 62 6f 69 64 5b |oid[i].avx/boid[|
00002030 69 5d 2e 61 63 2c 20 72 6d 2d 64 29 2b 6d 75 6c |i].ac, rm-d)+mul|
00002040 5f 66 72 61 63 31 36 28 64 2d 72 63 2c 20 61 2a |_frac16(d-rc, a*|
00002050 67 29 20 2c 20 72 6d 2d 72 63 20 29 3b 0a 20 20 |g) , rm-rc );. |
00002060 20 20 20 20 20 20 20 20 76 79 20 3d 20 64 69 76 | vy = div|
00002070 5f 66 72 61 63 31 36 28 20 6d 75 6c 5f 66 72 61 |_frac16( mul_fra|
00002080 63 31 36 28 62 6f 69 64 5b 69 5d 2e 61 76 79 2f |c16(boid[i].avy/|
00002090 62 6f 69 64 5b 69 5d 2e 61 63 2c 20 72 6d 2d 64 |boid[i].ac, rm-d|
000020a0 29 2b 6d 75 6c 5f 66 72 61 63 31 36 28 64 2d 72 |)+mul_frac16(d-r|
000020b0 63 2c 20 62 2a 67 29 20 2c 20 72 6d 2d 72 63 20 |c, b*g) , rm-rc |
000020c0 29 3b 0a 20 20 20 20 20 20 20 20 7d 0a 20 20 20 |);. }. |
000020d0 20 20 20 20 20 65 6c 73 65 20 7b 0a 20 20 20 20 | else {. |
000020e0 20 20 20 20 20 20 64 20 20 3d 20 64 69 76 5f 66 | d = div_f|
000020f0 72 61 63 31 36 28 64 2c 20 72 6d 29 3b 0a 20 20 |rac16(d, rm);. |
00002100 20 20 20 20 20 20 20 20 69 66 20 28 64 3e 31 36 | if (d>16|
00002110 2a 6f 6e 65 29 20 64 3d 31 36 2a 6f 6e 65 3b 0a |*one) d=16*one;.|
00002120 20 20 20 20 20 20 20 20 20 20 76 78 20 3d 20 6d | vx = m|
00002130 75 6c 5f 66 72 61 63 31 36 28 64 2c 20 61 2a 67 |ul_frac16(d, a*g|
00002140 29 3b 0a 20 20 20 20 20 20 20 20 20 20 76 79 20 |);. vy |
00002150 3d 20 6d 75 6c 5f 66 72 61 63 31 36 28 64 2c 20 |= mul_frac16(d, |
00002160 62 2a 67 29 3b 0a 20 20 20 20 20 20 20 20 7d 0a |b*g);. }.|
00002170 20 20 20 20 20 20 7d 0a 20 20 20 20 7d 0a 20 20 | }. }. |
00002180 20 20 64 20 3d 20 6d 61 67 6e 69 74 75 64 65 28 | d = magnitude(|
00002190 76 78 2c 76 79 29 3b 0a 20 20 20 20 69 66 20 28 |vx,vy);. if (|
000021a0 64 3c 67 2a 6f 6e 65 29 20 7b 0a 20 20 20 20 20 |d<g*one) {. |
000021b0 20 76 78 20 3d 20 64 69 76 5f 66 72 61 63 31 36 | vx = div_frac16|
000021c0 28 76 78 2a 67 2c 64 29 3b 0a 20 20 20 20 20 20 |(vx*g,d);. |
000021d0 76 79 20 3d 20 64 69 76 5f 66 72 61 63 31 36 28 |vy = div_frac16(|
000021e0 76 79 2a 67 2c 64 29 3b 0a 20 20 20 20 20 20 64 |vy*g,d);. d|
000021f0 20 20 3d 20 67 2a 6f 6e 65 3b 0a 20 20 20 20 7d | = g*one;. }|
00002200 0a 20 20 20 20 62 6f 69 64 5b 69 5d 2e 78 6e 20 |. boid[i].xn |
00002210 3d 20 62 6f 69 64 5b 69 5d 2e 78 2b 76 78 3b 0a |= boid[i].x+vx;.|
00002220 20 20 20 20 62 6f 69 64 5b 69 5d 2e 79 6e 20 3d | boid[i].yn =|
00002230 20 62 6f 69 64 5b 69 5d 2e 79 2b 76 79 3b 0a 20 | boid[i].y+vy;. |
00002240 20 20 20 62 6f 69 64 5b 69 5d 2e 76 78 20 3d 20 | boid[i].vx = |
00002250 76 78 3b 0a 20 20 20 20 62 6f 69 64 5b 69 5d 2e |vx;. boid[i].|
00002260 76 79 20 3d 20 76 79 3b 0a 20 20 20 20 62 6f 69 |vy = vy;. boi|
00002270 64 5b 69 5d 2e 6d 76 20 3d 20 64 3b 0a 20 20 7d |d[i].mv = d;. }|
00002280 0a 20 20 66 6f 72 20 28 69 3d 30 3b 20 69 3c 6e |. for (i=0; i<n|
00002290 3b 20 69 2b 2b 29 20 7b 0a 20 20 20 20 62 6f 69 |; i++) {. boi|
000022a0 64 5b 69 5d 2e 78 20 3d 20 62 6f 69 64 5b 69 5d |d[i].x = boid[i]|
000022b0 2e 78 6e 3b 0a 20 20 20 20 62 6f 69 64 5b 69 5d |.xn;. boid[i]|
000022c0 2e 79 20 3d 20 62 6f 69 64 5b 69 5d 2e 79 6e 3b |.y = boid[i].yn;|
000022d0 0a 20 20 7d 0a 7d 0a 0a 69 6e 74 20 6d 61 69 6e |. }.}..int main|
000022e0 28 76 6f 69 64 29 0a 7b 0a 20 20 69 6e 74 20 69 |(void).{. int i|
000022f0 3b 0a 20 20 69 66 20 28 21 69 6e 69 74 28 29 29 |;. if (!init())|
00002300 20 72 65 74 75 72 6e 20 30 3b 0a 20 20 66 6f 72 | return 0;. for|
00002310 20 28 73 69 6e 67 6c 65 5f 73 74 65 70 3d 46 41 | (single_step=FA|
00002320 4c 53 45 3b 3b 29 20 7b 0a 20 20 20 20 74 74 6f |LSE;;) {. tto|
00002330 74 61 6c 3d 63 6c 6f 63 6b 28 29 3b 0a 20 20 20 |tal=clock();. |
00002340 20 62 62 63 5f 63 6c 73 28 29 3b 0a 20 20 20 20 | bbc_cls();. |
00002350 6d 6f 76 65 5f 62 6f 69 64 73 28 29 3b 0a 20 20 |move_boids();. |
00002360 20 20 63 68 65 63 6b 5f 6d 6f 75 73 65 28 29 3b | check_mouse();|
00002370 0a 20 20 20 20 66 6f 72 20 28 69 3d 30 3b 20 69 |. for (i=0; i|
00002380 3c 6e 3b 20 69 2b 2b 29 20 7b 0a 20 20 20 20 20 |<n; i++) {. |
00002390 20 62 62 63 5f 6d 6f 76 65 28 62 6f 69 64 5b 69 | bbc_move(boid[i|
000023a0 5d 2e 78 2f 6f 6e 65 2c 20 62 6f 69 64 5b 69 5d |].x/one, boid[i]|
000023b0 2e 79 2f 6f 6e 65 29 3b 0a 20 20 20 20 20 20 62 |.y/one);. b|
000023c0 62 63 5f 64 72 61 77 62 79 28 28 62 6f 69 64 5b |bc_drawby((boid[|
000023d0 69 5d 2e 76 78 2a 32 2a 67 29 2f 62 6f 69 64 5b |i].vx*2*g)/boid[|
000023e0 69 5d 2e 6d 76 2c 20 28 62 6f 69 64 5b 69 5d 2e |i].mv, (boid[i].|
000023f0 76 79 2a 32 2a 67 29 2f 62 6f 69 64 5b 69 5d 2e |vy*2*g)/boid[i].|
00002400 6d 76 29 3b 0a 20 20 20 20 7d 0a 20 20 20 20 66 |mv);. }. f|
00002410 6f 72 20 28 69 3d 30 3b 20 69 3c 70 6e 3b 20 69 |or (i=0; i<pn; i|
00002420 2b 2b 29 20 62 62 63 5f 63 69 72 63 6c 65 28 70 |++) bbc_circle(p|
00002430 69 6c 6c 61 72 5b 69 5d 2e 78 2f 6f 6e 65 2c 20 |illar[i].x/one, |
00002440 70 69 6c 6c 61 72 5b 69 5d 2e 79 2f 6f 6e 65 2c |pillar[i].y/one,|
00002450 20 70 69 6c 6c 61 72 5b 69 5d 2e 72 2f 6f 6e 65 | pillar[i].r/one|
00002460 29 3b 0a 20 20 20 20 74 74 6f 74 61 6c 3d 63 6c |);. ttotal=cl|
00002470 6f 63 6b 28 29 2d 74 74 6f 74 61 6c 3b 0a 20 20 |ock()-ttotal;. |
00002480 20 20 69 66 20 28 62 62 63 5f 69 6e 6b 65 79 28 | if (bbc_inkey(|
00002490 2d 33 36 29 29 20 70 72 69 6e 74 66 28 22 25 69 |-36)) printf("%i|
000024a0 5c 6e 25 69 5c 6e 22 2c 74 6e 32 2c 74 74 6f 74 |\n%i\n",tn2,ttot|
000024b0 61 6c 29 3b 0a 20 20 20 20 6f 73 5f 73 77 69 31 |al);. os_swi1|
000024c0 28 4f 53 5f 42 79 74 65 2c 20 31 39 29 3b 0a 20 |(OS_Byte, 19);. |
000024d0 20 20 20 73 77 61 70 5f 62 61 6e 6b 73 28 29 3b | swap_banks();|
000024e0 0a 20 20 20 20 73 74 65 70 28 29 3b 0a 20 20 20 |. step();. |
000024f0 20 69 66 20 28 6b 62 68 69 74 28 29 29 0a 20 20 | if (kbhit()). |
00002500 20 20 20 20 69 66 20 28 21 69 6e 69 74 28 29 29 | if (!init())|
00002510 20 62 72 65 61 6b 3b 0a 20 20 7d 0a 20 20 72 65 | break;. }. re|
00002520 74 75 72 6e 20 30 3b 0a 7d 0a |turn 0;.}.|
0000252a 
.