////////////// OpenGL CGCore for 2D Functions ver 1 /////////////////
#include <stdio.h>
#include <math.h>
#include <GL/glut.h>
#include "CGCore2D.h"

void C_Point::draw()
{
	color.set();
	glBegin(GL_POINTS);
		glVertex2f(x, y);
	glEnd();
}

C_Line::C_Line(float x1,float y1,float x2,float y2,C_Color col)
{
	p.x=x1;p.y=y1;q.x=x2;q.y=y2,color=col;
	p.t=1.;q.t=1.;
}

void C_Line::draw()
{
	color.set();
	glBegin(GL_LINES);
		glVertex2f(p.x, p.y);
		glVertex2f(q.x, q.y);
	glEnd();
}

C_Polyline::C_Polyline(C_Point *p0,int numberPoints0)
{
	int i;
	numberPoints=numberPoints0;
	p=new C_Point[numberPoints];
	for (i=0;i<numberPoints;i++) p[i]=p0[i];
}

C_Polyline::C_Polyline(C_Point *p0,int numberPoints0,C_Color color0)
{
	int i;
	numberPoints=numberPoints0;
	p=new C_Point[numberPoints];
	for (i=0;i<numberPoints;i++) p[i]=p0[i];
	color=color0;
}

C_Polyline::C_Polyline(C_Polyline &pl)
{
	int i;
	numberPoints=pl.numberPoints;
	p=new C_Point[numberPoints];
	for (i=0;i<numberPoints;i++) p[i]=pl.p[i];
	color=pl.color;
}

C_Polyline::~C_Polyline()
{
	if (numberPoints) delete[] p;
	numberPoints=0;
}

C_Polyline C_Polyline::operator =(const C_Polyline &pl)
{
	int i;
	if (numberPoints) delete[] p;
	numberPoints=pl.numberPoints;
	p=new C_Point[numberPoints];
	for (i=0;i<numberPoints;i++) p[i]=pl.p[i];
	color=pl.color;
	return *this;
}

void C_Polyline::draw()
{
	int i;
	color.set();
	glBegin(GL_LINE_STRIP);
		for (i=0;i<numberPoints;i++) {
			glVertex2f(p[i].x, p[i].y);
		}
	glEnd();
}

C_Polygon::C_Polygon(C_Point *p0,int numberPoints0)
{
	int i;
	numberPoints=numberPoints0;
	p=new C_Point[numberPoints];
	for (i=0;i<numberPoints;i++) p[i]=p0[i];
	colorarray=NULL;
	C_Color white(1.,1.,1.);
	color=white;
}

C_Polygon::C_Polygon(C_Point *p0,int numberPoints0,C_Color color0)
{
	int i;
	numberPoints=numberPoints0;
	p=new C_Point[numberPoints];
	for (i=0;i<numberPoints;i++) p[i]=p0[i];
	colorarray=NULL;
	color=color0;
}

C_Polygon::C_Polygon(C_Point *p0,C_Color *colorarray0,int numberPoints0)
{
	int i;
	numberPoints=numberPoints0;
	p=new C_Point[numberPoints];
	colorarray=new C_Color[numberPoints];
	for (i=0;i<numberPoints;i++) { p[i]=p0[i]; colorarray[i]=colorarray0[i]; }
	C_Color white(1.,1.,1.);
	color=white;
}

C_Polygon::C_Polygon(C_Polygon &pg)
{
	int i;
	color=pg.color;
	if (pg.colorarray!=NULL) {
		numberPoints=pg.numberPoints;
		p=new C_Point[numberPoints];
		colorarray=new C_Color[numberPoints];
		for (i=0;i<numberPoints;i++) { p[i]=pg.p[i]; colorarray[i]=pg.colorarray[i]; }
	} else {
		numberPoints=pg.numberPoints;
		p=new C_Point[numberPoints];
		for (i=0;i<numberPoints;i++) p[i]=pg.p[i];
		colorarray=NULL;
	}
}

C_Polygon::~C_Polygon()
{
	if (numberPoints) delete[] p;
	if (colorarray!=NULL) delete[] colorarray;
	numberPoints=0;
}

C_Polygon C_Polygon::operator =(const C_Polygon &pg)
{
	int i;
	if (numberPoints) delete[] p;
	if (colorarray!=NULL) delete[] colorarray;
	color=pg.color;
	if (pg.colorarray!=NULL) {
		numberPoints=pg.numberPoints;
		p=new C_Point[numberPoints];
		colorarray=new C_Color[numberPoints];
		for (i=0;i<numberPoints;i++) { p[i]=pg.p[i]; colorarray[i]=pg.colorarray[i]; }
	} else {
		numberPoints=pg.numberPoints;
		p=new C_Point[numberPoints];
		for (i=0;i<numberPoints;i++) p[i]=pg.p[i];
		colorarray=NULL;
	}
	return *this;
}

void C_Polygon::draw()
{
	int i;
	color.set();
	glBegin(GL_LINE_LOOP);
		for (i=0;i<numberPoints;i++) {
			glVertex2f(p[i].x, p[i].y);
		}
	glEnd();
}

void C_Polygon::fill()
{
	int i;
	color.set();
	glBegin(GL_POLYGON);
		for (i=0;i<numberPoints;i++) {
			glVertex2f(p[i].x, p[i].y);
		}
	glEnd();
}

void C_Polygon::gradate()
{
	int i;
	glBegin(GL_POLYGON);
		for (i=0;i<numberPoints;i++) {
			colorarray[i].set();
			glVertex2f(p[i].x, p[i].y);
		}
	glEnd();
}

C_Matrix::C_Matrix()
{
	int i,j;
	for (i=0;i<3;i++) {
		for(j=0;j<3;j++) m[i][j]=0.;
		m[i][i]=1.;
	}
}

C_Matrix::C_Matrix(const C_Matrix &mx)
{
	int i,j;
	for (i=0;i<3;i++) for(j=0;j<3;j++) m[i][j]=mx.m[i][j];
}

C_Matrix::C_Matrix(const float m0[3][3])
{
	int i,j;
	for (i=0;i<3;i++) for(j=0;j<3;j++) m[i][j]=m0[i][j];
}

C_Matrix C_Matrix::operator =(const C_Matrix &mx)
{
	int i,j;
	for (i=0;i<3;i++) for(j=0;j<3;j++) m[i][j]=mx.m[i][j];
	return *this;
}

void C_Matrix::createidentity()
{
	int i,j;
	for (i=0;i<3;i++) {
		for(j=0;j<3;j++) m[i][j]=0.;
		m[i][i]=1.;
	}
}

void C_Matrix::setTranslation(C_Vector v)
{
	createidentity();
	m[0][2]=v.x;
	m[1][2]=v.y;
}

void C_Matrix::setTranslation(float dx,float dy)
{
	createidentity();
	m[0][2]=dx;
	m[1][2]=dy;
}

void C_Matrix::setRotation(float theta)
{
	createidentity();
	float cs=cos(theta);
	float sn=sin(theta);
	m[0][0]=cs; m[0][1]=-sn;
	m[1][0]=sn; m[1][1]=cs;
}

void C_Matrix::setScale(float fx,float fy)
{
	createidentity();
	m[0][0]=fx;
	m[1][1]=fy;
}

C_Matrix operator * (const C_Matrix &a, const C_Matrix &b)
{
	C_Matrix c;//c=a*b
	int i,j,k;
	for (i=0;i<3;i++) for (j=0;j<3;j++) {
		c.m[i][j]=0;
		for (k=0;k<3;k++) c.m[i][j]+=a.m[i][k]*b.m[k][j];
	}
	return c;
}

C_Point operator * (const C_Matrix &a, const C_Point &b)
{
	C_Point c;//c=a*b
	c.x=a.m[0][0]*b.x+a.m[0][1]*b.y+a.m[0][2]*b.t;
	c.y=a.m[1][0]*b.x+a.m[1][1]*b.y+a.m[1][2]*b.t;
	c.t=a.m[2][0]*b.x+a.m[2][1]*b.y+a.m[2][2]*b.t;
	return c;
}

C_Line operator * (const C_Matrix &a, const C_Line &b)
{
	C_Line c;//c=a*b
	c.p=a*b.p;
	c.q=a*b.q;
	c.color=b.color;
	return c;
}

C_Polyline operator * (const C_Matrix &a, const C_Polyline &b)
{
	C_Polyline c;//c=a*b
	int i;
	c=b;
	for (i=0;i<b.numberPoints;i++) c.p[i]=a*b.p[i];
	return c;
}

C_Polygon operator * (const C_Matrix &a, const C_Polygon &b)
{
	C_Polygon c;//c=a*b
	int i;
	c=b;
	for (i=0;i<b.numberPoints;i++) c.p[i]=a*b.p[i];
	return c;
}