コード例 #1
0
ファイル: TagObject.cpp プロジェクト: jay3ss/Swarmathon-ROS
void TagObject::setDistance()
{
  linear_distance_ = sqrt(x_ * x_ + y_ * y_);
  if (x_ == 0 || y_ == 0)
  {
    onAxis();
  }
  else if (x_ > 0 && y_ > 0)
  {
    angular_distance_ = atan(x_ / y_);
  }
  else if (x_ > 0 && y_ < 0)
  {
    angular_distance_ = atan((-y_) / x_) + PI / 2;
  }
  else if (x_ < 0 && y_ < 0)
  {
    angular_distance_ = atan((-x_) / (-y_)) + PI;
  }
  else if (x_ < 0 && y_ > 0)
  {
    angular_distance_ = atan(y_ / (-x_)) + PI * 3 / 2;
  }
}
コード例 #2
0
ファイル: Joystick.cpp プロジェクト: hnauen/Arduino
void Joystick::onAxis(Axis axis, JoystickAxisCallbackFunction cbFunction){
	onAxis(axis, defaultAnalogPin[axis], cbFunction);
}