SvgaLib/demos/spin.c

391 lines
11 KiB
C

/*
spin.c - A simple (or not quite so) app to test the SpaceOrb by rotating
a shape of a given number of sides.
Copyright (C) 1997 Eric Sharkey, Jason Lyons, Brett Viren
This program is free software; you can redistribute it and/or modify
it under the terms of the GNU General Public License as published by
the Free Software Foundation; either version 2 of the License, or
(at your option) any later version.
This program is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
GNU General Public License for more details.
You should have received a copy of the GNU General Public License
along with this program; if not, write to the Free Software
Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
---- end copyleft notice ----
This program is FREE!!! However, if you feel that nothing is free and you
refuse to use something someone else made unless paid for, you can send a
donation to me (Jason Lyons). For information on this, E-MAIL me at
jason_l@hotmail.com.
This graphical test program was originally written by Jason Lyons and
later hacked to bits by Eric Sharkey, but this program would not be
possible without Brett's efforts. Be sure to thank him!
The original code for the SpaceOrb in Unix/Linux was written by Brett Viren
(Brett.Viren@sunysb.edu) on his free time (ie, not when on the pay
clock of SUNY@Stony Brook). Do with it what you will, as long as
you abide by the GPL.
I think by now all of Brett's code has been removed from this demo
and incorporated into svgalib itself, but he's still responsible for
starting this whole thing.
*/
#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include <vga.h>
#include <vgagl.h>
#include <vgamouse.h>
#include <malloc.h>
#include "spintables.h"
#define DONT_MANUALLY_SETUP_MOUSE
#define NODEBUG
#define GMODE 5
#define SCREEN_WIDTH 320
#define SCREEN_HEIGHT 200
#define SCREEN_DEPTH 100
#ifndef ROTATION_ONLY
/* Note: 6-D protocol assumes x is left/right, y is in/out, and z is up/down, */
/* which is logical for a three d environment, but for this demo all plotting */
/* is done with x/y only, so we remap y onto z and vice versa here by */
/* defining y as coordinate 2 and z as coordinate 1 */
#define SCR_XCTR t[0]
#define SCR_YCTR t[2]
#define SCR_ZCTR (((float) t[1])/((float) SCREEN_DEPTH))
#else
#define SCR_XCTR (SCREEN_WIDTH/2)
#define SCR_YCTR (SCREEN_HEIGHT/2)
#define SCR_ZCTR 1
#endif
#define SCREEN_SIZE (SCREEN_WIDTH*SCREEN_HEIGHT)
#define LAYERS 6
#define MAX_NUM_SIDES 20
#define MAX_NUM_POINTS MAX_NUM_SIDES*LAYERS
#define HORIZONTAL 0
typedef unsigned short WORD;
typedef unsigned char BYTE;
typedef unsigned int DWORD;
typedef struct {
float x, y, z;
} POINT3D;
int CurrentColor=12;
int Depth[LAYERS] = { -45, -35, -10, +10, +35, +45 };
int Radius[LAYERS] = { 5, 50, 75, 75, 50, 5 };
int InitGraph(int mode);
void InitPoints(POINT3D *Points, int sides);
void SetColor(char c);
char GetColor(void);
void SetPixel(int x, int y, char c);
void line(int x1, int y1, int x2, int y2);
void Update(void);
void Clear(void);
void RotateX(POINT3D *dest, POINT3D src, int a);
void RotateY(POINT3D *dest, POINT3D src, int a);
void RotateZ(POINT3D *dest, POINT3D src, int a);
GraphicsContext *screen;
char *buf;
int main(void)
{
int scale=100, a, b, c;
POINT3D *Points;
int sides;
int NUM_POINTS;
int t[3], r[3], oldbutton=0, button=0;
#ifdef MANUALLY_SETUP_MOUSE
char orbdev[1024] = "/dev/ttyS0";
#endif
printf("\n\n Welcome to SPIN\n\n");
printf(" Spin is a graphical rotation program for Linux which uses the SVGA library.\n");
printf("It's purpose is to demonstrate the new six dimensional mouse driver support.\n");
printf("So far this driver only supports the Spaceball series of controllers including\n");
printf("the Spaceball Avenger and SpaceOrb 360. Spin may be used with any mouse type\n");
printf("but two dimensional mice will only be able to move the image in two dimensions.\n\n");
printf("Spin was originally written by Jason Lyons, based on the SpaceOrb readout code\n");
printf("developed by Brett Viren and others. Eric Sharkey incorporated Brett's code\n");
printf("into svgalib and adapted spin accordingly.\n\n");
printf("Button Functions:\n");
printf(" A - Decrease Sensitivity (Right Mouse Button)\n");
printf(" B - Change color (Middle Mouse Button)\n");
printf(" C - Increase Sensitivity (Left Mouse Button)\n");
printf(" D - Increase Number of Sides\n");
printf(" E - Decrease Number of Sides\n");
printf(" F - Quit (CTRL-C)\n");
printf(" Reset button toggles orientation (default is vertical) \n\n");
printf("Warning: Default sensitivity optimized for spaceball.\n");
printf("Most mice will need to increase this setting.\n");
printf("\nHow many sides to start with (MAX %d) ? ",MAX_NUM_SIDES);
scanf("%d", &c);
if(c == 0) exit(1);
else if(c < 0) printf("\nCannot draw a negative number of sides.\n"), exit(1);
else if(c > MAX_NUM_SIDES) printf("\nCannot draw with more sides than %d.\n",MAX_NUM_SIDES), exit(1);
sides = c;
NUM_POINTS = sides*LAYERS;
Points = (POINT3D *)calloc(MAX_NUM_POINTS, sizeof(POINT3D));
InitPoints(Points,sides);
printf("Initializing mouse\n");
#ifdef MANUALLY_SETUP_MOUSE
if (mouse_init(orbdev,MOUSE_SPACEBALL,MOUSE_DEFAULTSAMPLERATE)) {
printf("mouse_init failed");
return -1;
} else {
printf("mouse_init successful\n");
}
#else
vga_setmousesupport(1);
#endif
if(!InitGraph(GMODE)) return 0;
mouse_setscale(scale);
mouse_setrange_6d(0,SCREEN_WIDTH,1,SCREEN_DEPTH,0,SCREEN_HEIGHT,-2,2,-2,2,-2,2,63);
mouse_setwrap(MOUSE_ROT_INFINITESIMAL);
mouse_setposition_6d(SCREEN_WIDTH/2,SCREEN_DEPTH/2,SCREEN_HEIGHT/2,0,0,0,63);
while(1)
{
mouse_update();
mouse_getposition_6d(&t[0],&t[1],&t[2],&r[0],&r[1],&r[2]);
#ifdef DEBUG
printf("%d %d %d\n",t[0],t[1],t[2]);
#endif
oldbutton = button;
button = mouse_getbutton();
if ((button & MOUSE_RIGHTBUTTON)&&!(oldbutton & MOUSE_RIGHTBUTTON)) {
scale += 5;
mouse_setscale(scale);
}
if ((button & MOUSE_LEFTBUTTON)&&!(oldbutton & MOUSE_LEFTBUTTON)) {
if (scale==1) {
printf("\007");
fflush(stdout);
} else {
if (scale>6)
scale -=5;
else
scale--;
mouse_setscale(scale);
}
}
if ((button & MOUSE_MIDDLEBUTTON)&&!(oldbutton & MOUSE_MIDDLEBUTTON))
CurrentColor = random() % 15 + 1;
if ((button & MOUSE_FOURTHBUTTON)&&!(oldbutton & MOUSE_FOURTHBUTTON)) {
if (sides>1) {
sides--;
NUM_POINTS = sides*LAYERS;
InitPoints(Points,sides);
} else {
printf("\007");
fflush(stdout);
}
}
if ((button & MOUSE_FIFTHBUTTON)&&!(oldbutton & MOUSE_FIFTHBUTTON)) {
if (sides<MAX_NUM_SIDES) {
sides++;
NUM_POINTS = sides*LAYERS;
InitPoints(Points,sides);
} else {
printf("\007");
fflush(stdout);
}
}
if (button & MOUSE_SIXTHBUTTON)
{
vga_setmode(0);
free(buf);
free(Points);
return 0;
}
for(a = 0; a < NUM_POINTS; a++) {
RotateX(&Points[a],Points[a],r[0]);
RotateY(&Points[a],Points[a],r[2]);
RotateZ(&Points[a],Points[a],r[1]);
Points[a].x *= SCR_ZCTR;
Points[a].y *= SCR_ZCTR;
Points[a].z *= SCR_ZCTR;
Points[a].x += SCR_XCTR;
Points[a].y += SCR_YCTR;
}
for(a = 0; a < LAYERS; a++)
{
for(b = 0; b < sides-1; b++)
{
/* Connect the points on each layer */
line(Points[a*sides+(b+1)].x,Points[a*sides+(b+1)].y,
Points[a*sides+b].x,Points[a*sides+b].y);
/* Connect between layers */
if(a < (LAYERS - 1))
{
line(Points[(a+1)*sides+b].x,Points[(a+1)*sides+b].y,
Points[a*sides+b].x,Points[a*sides+b].y);
}
}
line(Points[a*sides+b].x,Points[a*sides+b].y,
Points[a*sides+0].x,Points[a*sides+0].y);
if(a < (LAYERS - 1))
{
line(Points[a*sides+b].x,Points[a*sides+b].y,
Points[(a+1)*sides+b].x,Points[(a+1)*sides+b].y);
}
}
for(a = 0; a < NUM_POINTS; a++) {
Points[a].x -= SCR_XCTR;
Points[a].y -= SCR_YCTR;
Points[a].x /= SCR_ZCTR;
Points[a].y /= SCR_ZCTR;
Points[a].z /= SCR_ZCTR;
}
Update();
Clear();
}
free(buf);
free(Points);
}
void SetColor(char c) { CurrentColor = c; }
char GetColor() { return CurrentColor; }
void SetPixel(int x, int y, char c)
{
if(x >= 0 && x < SCREEN_WIDTH && y >= 0 && y < SCREEN_HEIGHT)
buf[y*SCREEN_WIDTH+x] = c;
}
void Clear() { memset((char *)buf, 0, SCREEN_SIZE); }
void Update()
{
memcpy((char *)screen->vbuf, (char *)buf, SCREEN_SIZE);
}
void InitPoints(POINT3D *Points, int sides)
{
int a, b, c;
for(a = 0; a < LAYERS; a++)
{
for(b = 0; b < sides; b++)
{
c=(b*360)/sides;
Points[a*sides+b].x = cosine[c] * Radius[a];
Points[a*sides+b].y = sine[c] * Radius[a];
Points[a*sides+b].z = Depth[a];
}
}
}
int InitGraph(int mode)
{
buf = (char *)malloc(SCREEN_SIZE);
if(!buf) return 0;
if(!vga_hasmode(mode)) return 0;
vga_setmode(mode);
gl_setcontextvga(mode);
screen = gl_allocatecontext();
gl_getcontext(screen);
gl_setcontextvgavirtual(mode);
gl_setcontext(screen);
return 1;
}
void RotateX(POINT3D *dest, POINT3D src, int a)
{
while (a<0) a+=360;
dest->x = src.x;
dest->y = src.y * cosine[a] + src.z * sine[a];
dest->z = -1 * src.y * sine[a] + src.z * cosine[a];
}
void RotateY(POINT3D *dest, POINT3D src, int a)
{
while (a<0) a+=360;
dest->x = -1 * src.z * sine[a] + src.x * cosine[a];
dest->y = src.y;
dest->z = src.z * cosine[a] + src.x * sine[a];
}
void RotateZ(POINT3D *dest, POINT3D src, int a)
{
while (a<0) a+=360;
dest->x = src.x * cosine[a] + src.y * sine[a];
dest->y = -1 * src.x * sine[a] + src.y * cosine[a];
dest->z = src.z;
}
void line(int x1, int y1, int x2, int y2)
{
int dx, dy;
int sx, sy;
int ax, ay;
int x, y, c=CurrentColor;
dx = x2 - x1;
dy = y2 - y1;
ax = abs(dx) << 1;
ay = abs(dy) << 1;
sx = (dx >= 0) ? 1 : -1;
sy = (dy >= 0) ? 1 : -1;
x = x1;
y = y1;
if (ax > ay)
{
int d = ay - (ax >> 1);
while (x != x2)
{
SetPixel(x, y, c);
if (d > 0 || (d == 0 && sx == 1))
{
y += sy;
d -= ax;
}
x += sx;
d += ay;
}
}
else
{
int sy = (dy >= 0) ? 1 : -1;
int d = ax - (ay >> 1);
while (y != y2)
{
SetPixel(x, y, c);
if (d > 0 || (d == 0 && sy == 1))
{
x += sx;
d -= ay;
}
y += sy;
d += ax;
}
}
SetPixel(x, y, c);
}