当前位置: 首页>>代码示例>>C++>>正文


C++ Arm::GetTilt方法代码示例

本文整理汇总了C++中Arm::GetTilt方法的典型用法代码示例。如果您正苦于以下问题:C++ Arm::GetTilt方法的具体用法?C++ Arm::GetTilt怎么用?C++ Arm::GetTilt使用的例子?那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在Arm的用法示例。


在下文中一共展示了Arm::GetTilt方法的1个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的C++代码示例。

示例1: control_arm_motor

/**
 * This function runs in the control thread, and continually sets the motors to the correct speed.
 * The speed is determined by the difference in angle divided by a constant.
 */
void Arm::control_arm_motor( void *object )
{
	Arm *instance = (Arm *) object;
	instance->upperArmAngle = instance->GetTilt();
	// Runs when the difference in angles is large enough
	//TODO: fix kCloseEnough with real value
	while ( fabs( instance->upperArmAngle - instance->arm_control_angle ) > kCloseEnough )
	{

		instance->upperArmAngle = instance->GetTilt();
		if (((instance->upperArmAngle-instance->arm_control_angle ) / 700 < 0.5) && ((instance->upperArmAngle-instance->arm_control_angle ) / 2000 > 0) )
		{
			instance->armMotor.Set(0.5);
		}
		else if (((instance->upperArmAngle-instance->arm_control_angle ) / 700 > -0.5) && ((instance->upperArmAngle-instance->arm_control_angle ) / 2000 < 0) )
		{
					instance->armMotor.Set(-0.5);
		}
		else if ((instance->upperArmAngle-instance->arm_control_angle ) / 700 >= 1.0 )
		{
			instance->armMotor.Set(1.0);
		}
		else if ((instance->upperArmAngle-instance->arm_control_angle ) / 700 <= -1.0 )
		{
			instance->armMotor.Set(-1.0);
		}
		else
		{
		instance->armMotor.Set( ( instance->upperArmAngle-instance->arm_control_angle ) / 700 );
		}
		Wait( 0.05 );		

	}

	instance->armMotor.Set( 0.0 );
}
开发者ID:Nashoba-Robotics,项目名称:Nashoba-Robotics,代码行数:40,代码来源:Arm.cpp


注:本文中的Arm::GetTilt方法示例由纯净天空整理自Github/MSDocs等开源代码及文档管理平台,相关代码片段筛选自各路编程大神贡献的开源项目,源码版权归原作者所有,传播和使用请参考对应项目的License;未经允许,请勿转载。