乐高机器人java程序代码_用JAVA编写一个乐高机器人躲避障碍物运动到目标点的程序....

以下是一个简单的乐高机器人躲避障碍物运动到目标点的 Java 程序代码示例：

import lejos.nxt.*;
import lejos.robotics.navigation.*;

public class LegoRobot {
    public static void main(String[] args) {
        DifferentialPilot pilot = new DifferentialPilot(2.25f, 4.5f, Motor.A, Motor.C);
        UltrasonicSensor ultrasonic = new UltrasonicSensor(SensorPort.S1);
        
        pilot.setTravelSpeed(10); // 设置旅行速度
        pilot.setRotateSpeed(45); // 设置旋转速度
        
        while (true) {
            // 获取超声波传感器距离
            int distance = ultrasonic.getDistance();
            
            if (distance < 15) {
                // 如果距离小于 15 厘米，向右转 90 度
                pilot.rotate(90);
            } else if (distance < 30) {
                // 如果距离小于 30 厘米，向右转 45 度
                pilot.rotate(45);
            } else {
                // 否则，向前移动一段距离
                pilot.travel(10);
            }
            
            // 判断是否到达目标点（示例中目标点为坐标 x=100, y=100）
            if (pilot.getX() >= 100 && pilot.getY() >= 100) {
                // 到达目标点，程序结束
                break;
            }
        }
    }
}

该程序使用了 Lejos NXJ 编程库，通过超声波传感器检测障碍物距离，避免与障碍物碰撞，向目标点移动。需要注意的是，该代码示例仅为演示用途，实际应用中还需要考虑更多的因素，如环境变化、误差调整等。