示例#1
0
void PWMCbTurn(const std_msgs::Int32& msg)
{
  if (isMovingForward)
  {
    if (msg.data > 0)
    {
      thrusterEast(255 - msg.data, true);
      thrusterWest(255 - msg.data, false);
    }
    else
    {
      thrusterEast(255 + msg.data, false);
      thrusterWest(255 + msg.data, true);
    }
  }
  else
  {
    if (msg.data > 0)
    {
      thrusterNorthSway(255 - msg.data, false);
      thrusterSouthSway(255 - msg.data, true);
    }
    else
    {
      thrusterNorthSway(255 + msg.data, true);
      thrusterSouthSway(255 + msg.data, false);
    }
  }
}
示例#2
0
void PWMCbTurn(const std_msgs::Int32 &msg)
{
  if (msg.data > 0)
  {
    thrusterNorthSway(msg.data, false);
    thrusterSouthSway(msg.data, true);
  }
  else
  {
    thrusterNorthSway(msg.data, true);
    thrusterSouthSway(msg.data, false);
  }
}
示例#3
0
void PWMCbSideward(const std_msgs::Int32 &msg)
{
  if (msg.data > 0)
  {
    thrusterNorthSway(msg.data, true);
    thrusterSouthSway(msg.data, true);
  }
  else
  {
    thrusterNorthSway(msg.data, false);
    thrusterSouthSway(msg.data, false);
  }
  isMovingForward = false;
}