Ryu Anzawa / wheel_an

tukaenakuhanai

Dependents:   wheel_test2 wheel_test3 wheel_test3

wheel_an.cpp

Committer:
piroro4560
Date:
2019-05-16
Revision:
1:fa804ec40e88
Parent:
0:1c8f29f4cd3d

File content as of revision 1:fa804ec40e88:

#include "wheel_an.h"

Wheelan::Wheelan(double Wheel_angle)
{
    wheel_angle = Wheel_angle;
}

double Wheelan::an_uc(double rad, double dis)
{
    value = sin(rad - wheel_angle) * dis;
    return value;
}

double Wheelan::an_xy(double x, double y)
{
    value = sin(atan2(y, x) - wheel_angle) * hypot(x, y);
    return value;
}