Advertisement
Guest User

asdf

a guest
Oct 20th, 2017
73
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.19 KB | None | 0 0
  1. import com.qualcomm.robotcore.eventloop.opmode.OpMode;
  2. import com.qualcomm.robotcore.hardware.DcMotor;
  3. import com.qualcomm.robotcore.hardware.DcMotorController;
  4.  
  5. public class Encoder {
  6. DcMotor objUpDown; //DcMotorController obj for up and down
  7. DcMotor objLeftRight; //DcMotorController obj for left and right
  8.  
  9. public Encoder(OpMode opMode){
  10. objUpDown = opMode.hardwareMap.dcMotor.get("encY");
  11. objLeftRight = opMode.hardwareMap.dcMotor.get("encX");
  12. }
  13. public int getTicks(DcMotor obj)
  14. {
  15. int currentTicks = obj.getCurrentPosition();
  16. return currentTicks;
  17. }
  18.  
  19. public double getDistanceTraveled(){
  20. if(getTicks(objUpDown) > 0) {
  21. double traveled = (getTicks(objUpDown) / 500) * (4 * Math.PI);
  22. return traveled; //inches traveled by the robot
  23. }
  24. else {
  25. return 0;
  26. }
  27. }
  28.  
  29. public double getDistanceTraveledLeftRight() {
  30. if (getTicks(objLeftRight) > 0) {
  31. double traveled = (getTicks(objLeftRight) / 500) * (4 * Math.PI);
  32. return traveled; //inches traveled by the robot
  33. }
  34. else{
  35. return 0;
  36. }
  37. }
  38. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement