Java Example

Introduction

This is a simple Java example demonstrating how to use the Vertos Encoder with the CANSense interface in an FRC robot project

Code Breakdown

1. Import the CANSense Library

   • import com.vertos.encoder.CANSense; - Allows communication with the Vertos Encoder over CAN.

2. Declare the Encoder Instance

   • private CANSense sensor1; - Creates an instance of CANSense to interact with the encoder.

3. Initialize the Encoder

   • sensor1 = new CANSense(0, false); - Instantiates the encoder with CAN ID 0 and debug mode disabled.

4. Read Encoder Data Periodically

   • sensor1.readMultiTurnCounts(); - Fetches the latest multi-turn count from the encoder.

   • long position = sensor1.getMultiTurnCounts(); - Retrieves the current position in multi-turn counts.

5. Output Encoder Data

   • System.out.println("Encoder Position: " + position); - Prints the encoder's position to the console for monitoring.

Code

// Copyright (c) FIRST and other WPILib contributors.
// Open Source Software; you can modify and/or share it under the terms of
// the WPILib BSD license file in the root directory of this project.

package frc.robot;

import edu.wpi.first.wpilibj.TimedRobot;
import edu.wpi.first.wpilibj2.command.Command;
import edu.wpi.first.wpilibj2.command.CommandScheduler;

import com.vertos.encoder.CANSense; // Import

public class Robot extends TimedRobot {
  private Command m_autonomousCommand;
  private final RobotContainer m_robotContainer;
  private CANSense sensor1; // CANSense encoder instance

  public Robot() {
    m_robotContainer = new RobotContainer();
    sensor1 = new CANSense(0, false); // Initialize encoder with CAN ID 0, debug mode off
  }

  @Override
  public void robotPeriodic() {
    CommandScheduler.getInstance().run();
    
    // Read encoder data
    sensor1.readMultiTurnCounts(); 
    long position = sensor1.getMultiTurnCounts(); // Get multi-turn count
    
    // Print encoder position to console
    System.out.println("Encoder Position: " + position);
  }

  @Override
  public void disabledInit() {}
  @Override
  public void disabledPeriodic() {}

  @Override
  public void autonomousInit() {
    m_autonomousCommand = m_robotContainer.getAutonomousCommand();
    if (m_autonomousCommand != null) {
      m_autonomousCommand.schedule();
    }
  }
  @Override
  public void autonomousPeriodic() {}

  @Override
  public void teleopInit() {
    if (m_autonomousCommand != null) {
      m_autonomousCommand.cancel();
    }
  }
  @Override
  public void teleopPeriodic() {}

  @Override
  public void testInit() {
    CommandScheduler.getInstance().cancelAll();
  }
  @Override
  public void testPeriodic() {}

  @Override
  public void simulationInit() {}
  @Override
  public void simulationPeriodic() {}
}