C++ (Cpp) goDistance示例

示例#1

文件： aFiveFeet.c 项目： Designosaurs/Code2015

task main() {
    initDisplay();
    goalGrabberUp();
    initPlacer();
    initElbow();
    initWrist();
    initDriveConfig();

    waitForStart();
    eraseDisplay();
    StartTask(UpdateLiftEncoderTask);
    StartTask(UpdateDisplayTask);
    StartTask(UpdateDriveBearingsTask);

		goDistance(5, 80, true);
}

示例#2

文件： Helm.cpp 项目： nckswt/FARSHAPE

void Helm::goTo( xyz location ) {
  
  xyz delta;
  float distance;
  float theta;
  
  delta.x = location.x - currentPos.x;
  delta.y = location.y - currentPos.y;
  delta.z = location.z - currentPos.z;
  
  distance = sqrt( pow(delta.x, 2) + pow(delta.y, 2) );
  theta = atanf( delta.x / delta.y ) - this->rotation;
  
  rotate( theta );
  goDistance( distance );
  
}