samrrr_bibl.h

#include <math.h>			// Header File For Math Library Routines
#include <stdio.h>			// Header File For Standard I/O Routines
#include <stdlib.h>			// Header File For Standard Library

typedef struct{
	float x, y, z;
}flo3f;

flo3f normvec(flo3f pos1);
void dd(float* x, float* y, float c, float d);
float ss(float x, float y, float x1, float y1);
float ddx(float c, float d);
float ddy(float c, float d);
void roate(float *x, float *y, float x1, float y1, float c);
float ras(float x, float y);
float ricosgr(float plos, float patr);

void dd(float* x, float* y, float c, float d)
{
	float s;
	s = c - 90;
	while (!(s < 360) && !(s >= 0))
	{
		if (s >= 360){ s = s - 360; };
		if (s < 0) { s = s + 360; };
	}
	s = s / 180 * 3.1416926;
	x[0] = cos(s)*d;
	y[0] = sin(s)*d;
}

float ss(float x, float y, float x1, float y1)
{
	float sx, sy;
	float u;
	sx = x;
	sy = y;
	if (sx - x1 == 0) { sx = sx + 0.0003; };
	u = atan((sy - y1) / (sx - x1)) * 180 / 3.1416926 + 90;
	if (x1 - sx > 0) { u = u + 180; };
	u = u - 180;
	while (!(u < 360) && !(u >= 0))
	{
		if (u >= 360){ u = u - 360; };
		if (u < 0) { u = u + 360; };
	}
	return u;
}

float ddx(float c, float d)
{
	float s;
	s = c - 90;
	while (!(s < 360) && !(s >= 0))
	{
		if (s >= 360){ s = s - 360; };
		if (s < 0) { s = s + 360; };
	}
	s = s / 180 * 3.1416926;
	return cos(s)*d;
}

float ddy(float c, float d)
{
	float s;
	s = c - 90;
	while (!(s < 360) && !(s >= 0))
	{
		if (s >= 360){ s = s - 360; };
		if (s < 0) { s = s + 360; };
	}
	s = s / 180 * 3.1416926;
	return sin(s)*d;
}

void roate(float *x, float *y, float x1, float y1, float c)
{
	float u, v;
	u = ss(x1, y1, x[0], y[0]);
	v = ras(x[0] - x1, y[0] - y1);
	x[0] = ddx(u + c, v);
	y[0] = ddy(u + c, v);
	x[0] += x1;
	y[0] += y1;
}

float ricosgr(float plos, float patr)
{
	return -(180 + patr - plos) + plos;
}

float ras(float x, float y)
{
	return sqrt(x*x + y*y);
}

float ras3f(float x, float y, float z)
{
	return sqrt(x*x + y*y + z*z);
}

flo3f normvec(flo3f vec)
{
	//vec/=ras3f(pos1.x,pos1.y,pos1.z);
	float u = ras3f(vec.x, vec.y, vec.z);
	vec.x /= u;
	vec.y /= u;
	vec.z /= u;

	return vec;
}

flo3f getvector(flo3f pos1, flo3f pos2)
{
	flo3f vec;
	//vec=pos2-pos1;
	vec.x = pos2.x - pos1.x;
	vec.y = pos2.y - pos1.y;
	vec.z = pos2.z - pos1.z;
	normvec(vec);

	return vec;
}