#include <stdlib.h>
#include <conio.h>
#include <alloc.h>
#include <memory.h>
#include <dos.h>
#include <stdio.h>
#include <math.h>


//3D CUBE DEMONSTRATION - NOT WORKING! PLEASE HELP!

//ALL VARIABLS
typedef unsigned char byte;
byte *On_Screen=(byte *)MK_FP(0xA000,0);

int X, Y, Z;
int X1, Y1, Z1;
int X2, Y2, Z2;
int X3, Y3, Z3;

int   XOrigin=160, YOrigin=100;  //Are the coordinates of the center of the video display
int   FocalDistance=200;         //Range 80-200 - Distance from the viewer to the screen
float RadiansPerDegree=0.0174533;
float Angle;

int No_Of_Vertex=8;
int ScreenX[8], ScreenY[8];    //For storing 2D Screen Coordinates

float Cube[8][3]      = {
			  {-50, 50,-50 }, //1
			  { 50, 50,-50 }, //2
			  {-50,-50,-50 }, //3
			  { 50,-50,-50 }, //4
			  {-50, 50, 50 }, //5
			  { 50, 50, 50 }, //6
			  {-50,-50, 50 }, //7
			  { 50,-50, 50 }, //8
			};

//KEYBOARD VARIABLES
int   ascii, scan, cont=1;
union REGS ii,oo;
char  kb;



//---------------------------- Screen Codes Begins --------------------------
void EnterMode13H(void)
{union REGS regs;regs.x.ax = 0x0013;int86(0x10, ®s, ®s);}

void LeaveMode13H(void)
{union REGS regs;regs.x.ax = 0x0003;int86(0x10, ®s, ®s);}
//------------------------------------------------------------------------------

//------------------------- Plot-Read Pixels Begins -------------------------
void PlotPixel (signed int x, signed int y, signed char c)
  {
    if ((x < 320) && (y < 200))
     { On_Screen[(y << 8) + (y << 6) + x] = c; }
  }

//------------------------------------------------------------------------------

//------------------------------- DrawCube BEGINS ------------------------------

DrawVertex()
  {
    int Vertices, Degrees;
    float ScaleFactor;
    PlotPixel(160,100,14); //MIDDLE OF THE SCREEN

    for (Degrees=0;Degrees<360;Degrees++)
      {
	for (Vertices=0;Vertices<8;Vertices++)  //DRAW VERTICES
	  {
	    Angle = (RadiansPerDegree*Degrees);
	    X =  Cube[Vertices][0];
	    Y =  Cube[Vertices][1];
	    Z =  Cube[Vertices][2];

	    Z += 500;
/*
	    //X-Axis <---- DISABLED
	    X =  X;
	    Y = (cos(Angle)*Y) - (sin(Angle)*Z);  
	    Z = (sin(Angle)*Y) + (cos(Angle)*Z);  

	    //Y-Axis <---- DISABLED
	    X =  (cos(Angle)*X) + (sin(Angle)*Z);
	    Y =  Y;
	    Z = -(sin(Angle)*X) + (cos(Angle)*Z);
*/
	    //Z-Axis <--- ENABLED - WORKING FINE!
	    X = (cos(Angle)*X) - (sin(Angle)*Y);
	    Y = (sin(Angle)*X) + (cos(Angle)*Y);
	    Z =  Z;

	    if (Z == 0) { Z = 1;} // Avoid division by zero

	    //3D to 2D Transformation
	    ScreenX[Vertices]=FocalDistance*X/Z+XOrigin;
	    ScreenY[Vertices]=FocalDistance*Y/Z+YOrigin;

	    PlotPixel(ScreenX[Vertices],ScreenY[Vertices],12);
	  }

	delay(30);

	for (Vertices=0;Vertices<8;Vertices++)
	  {
	    PlotPixel(ScreenX[Vertices],ScreenY[Vertices],0);
	  }
      }
  }
//------------------------------- DrawCube ENDS ------------------------------
void main()
  {
    EnterMode13H();
    DrawVertex();
    do
      {
	if (kbhit())
	  {
	    ii.h.ah=0;
	    int86 (22,&ii,&oo);
	    ascii=oo.h.al;
	    scan=oo.h.ah;

	    switch (scan)
	      {
		case  1: //ESC   KEY PRESSED
		cont = 0; farfree(On_Screen); LeaveMode13H();
		break;
	      }
	  }
      }
    while (cont == 1);
  }