From Electronics\Hexapod\Arduino sketches 2011-2012\hexapod_oud (banner 'Version 3.0').
16 lines
257 B
C++
16 lines
257 B
C++
// atan2.cpp
|
|
|
|
#include "atan2.h"
|
|
|
|
void joy::JoyToDegAndDis (int x, int y)
|
|
{
|
|
deg = !(90 + degrees(atan2(y, x)));
|
|
distance = sqrt(y^2 + x^2);
|
|
}
|
|
|
|
int joy::JoyToDeg (int x, int y)
|
|
{ // watchout 90 + does not work good
|
|
return !(degrees(atan2(y, x)));
|
|
}
|
|
|