navigoalori.java

来自「单片机上的java虚拟机 用winavr 编译」· Java 代码 · 共 35 行

package ctbot.utils;

import nanovm.ctbot.drivers.*;
import nanovm.lang.Math;
import ctbot.utils.Odometry;
import ctbot.utils.Navigator;


public class NaviGoalOri extends NaviGoal {
  private float targetOri;
  private float targetDelta;

  public NaviGoalOri(float ori, float delta) {
    targetOri = ori;
    targetDelta = delta;
    this.subGoal = null;
    this.nextGoal = null;
  }

  public boolean work(){
    float dori = Odometry.normalizeOri(targetOri-Odometry.ori);

    if (Math.abs(dori)<targetDelta)
      return false;

    if (dori<0.0f)
      Navigator.goRotate(Navigator.checkTurnSpeed(-Navigator.MAX_SPEED, dori));
    if (dori>0.0f)
      Navigator.goRotate(Navigator.checkTurnSpeed(Navigator.MAX_SPEED, dori));
    
    return true; // Goal needs additional work...
  }

}