lejos.hardware.device.tetrix.TetrixMotor Maven / Gradle / Ivy

Go to download

Show more of this group Show more artifacts with this name
Show all versions of lejos-ev3-api Show documentation

leJOS (pronounced like the Spanish word "lejos" for "far") is a tiny Java Virtual Machine. In 2013 it was ported to the LEGO EV3 brick.

The newest version!

package lejos.hardware.device.tetrix;

import lejos.robotics.DCMotor;

/** 
 * Tetrix basic DC motor abstraction without encoder support. The default power at instantiation is 100%.
 * Use {@link TetrixMotorController#getBasicMotor} to retrieve a TetrixMotor instance.
 * 
 * @author Kirk P. Thompson
 */
public class TetrixMotor implements DCMotor{
    TetrixMotorController mc;
    int channel;
    
    TetrixMotor(TetrixMotorController mc, int channel) {
        this.mc=mc;
        this.channel=channel;
        setPower(100);
    }

    public void setPower(int power) {
        power=Math.abs(power);
        if (power>100) power=100;
        mc.doCommand(TetrixMotorController.CMD_SETPOWER, power, channel);
    }

    public int getPower() {
        return mc.doCommand(TetrixMotorController.CMD_GETPOWER, 0, channel);
    }
    
    public void forward() {
        mc.doCommand(TetrixMotorController.CMD_FORWARD, 0, channel);
    }

    public void backward() {
        mc.doCommand(TetrixMotorController.CMD_BACKWARD, 0, channel);
    }

    public void stop() {
        mc.doCommand(TetrixMotorController.CMD_STOP, 0, channel);
    }

    public void flt() {
        mc.doCommand(TetrixMotorController.CMD_FLT, 0, channel);
    }
    
    /**
     * Return true if the motor is moving. Note that this method reports based on the current control
     * state (i.e. commanded to move) and not if the motor is actually moving. This means a motor may be stalled but this
     * method would return true.
     *
     * @return true if the motor is executing a movement command, false if stopped.
     */
    public boolean isMoving() {
        return TetrixMotorController.MOTPARAM_OP_TRUE==mc.doCommand(TetrixMotorController.CMD_ISMOVING, 0, channel);
    }

    /** 
     * Used to alter the forward/reverse direction mapping for the motor output. This is primarily intended to
     * harmonize the forward and reverse directions for motors on opposite sides of a skid-steer chassis.
     * 
     * Changes to this setting take effect on the next motor command.
     * @param reverse true to reverse direction mapping for this motor
     */
    public void setReverse(boolean reverse) {
        int op=TetrixMotorController.MOTPARAM_OP_FALSE;
        if (reverse) op=TetrixMotorController.MOTPARAM_OP_TRUE;
        mc.doCommand(TetrixMotorController.CMD_SETREVERSE, op, channel);
    }
}