Untested 2laser code

using onboard serial
This commit is contained in:
Elijah Price
2019-02-15 18:43:38 -08:00
parent 085d348598
commit 78f923e380
2 changed files with 15 additions and 3 deletions
@@ -28,7 +28,19 @@ public class LaserToDash extends Command {
// Called repeatedly when this Command is scheduled to run
@Override
protected void execute() {
SmartDashboard.putNumber("Laser Raw Out", Robot.rangefinder.getDistance());
String p1, p2;
try{
String toParse = Robot.rangefinder.getDistance();
String[] parts = toParse.split("s");
p1 = parts[0];
p2 = parts[1];
}
catch(Exception nullException){
p1 = "0";
p2 = "0";
}
SmartDashboard.putNumber("Laser 1 raw out", Double.parseDouble(p1));
SmartDashboard.putNumber("Laser 2 raw out", Double.parseDouble(p2));
}
// Make this return true when this Command no longer needs to run execute()
@@ -28,7 +28,7 @@ public class Rangefinder extends Subsystem {
// setDefaultCommand(new MySpecialCommand());
setDefaultCommand(new LaserToDash());
}
public double getDistance(){
return Double.valueOf(laser1.readString());
public String getDistance(){
return laser1.readString();
}
}