mangavalk
fe472bfce9
From Electronics\Hexapod\Arduino sketches 2011-2012\hexapod_oud (banner 'Version 3.0').
24 lines
372 B
C++
24 lines
372 B
C++
// Rotation.cpp
|
|
|
|
#include "Rotation.h"
|
|
|
|
void Rotation::getData(int ix[6], int iy[6], int iz[6])
|
|
{
|
|
for (int i=0; i<6; i++)
|
|
{
|
|
x[i] = ix[i];
|
|
y[i] = iy[i];
|
|
z[i] = iz[i];
|
|
}
|
|
}
|
|
|
|
int NewX, NewY;
|
|
void rotate (int x, int y, int angel)
|
|
{
|
|
NewY = x * sin(radians(angel)) + y * cos(radians(angel));
|
|
NewX = x * cos(radians(angel)) - y * sin(radians(angel));
|
|
}
|
|
|
|
|
|
|