Simbad Simulator probleme mit Sensordaten...

littles_de

Neues Mitglied
Hi!
Um mir selbst etwas Java beizubringen habe ich mich dazu entschieden mit Simbad eher spielerisch damit zu beginnen. Im Moment versuche ich die Position des Roboters auf einer 2 Dimensionalen Karte auszugeben und die Daten des Sonarsensors auf der Karte anzuzeigen. Das funktioniert soweit ja auch schon recht gut, abgesehen von den Sensordaten( siehe Screenshot).
screenshot.png
ich hoffe ihr könnt mir helfen, ich denke es liegt daran das mir die Position der Sensoren unbekannt ist und ich vom mittelpunkt des Roboters aus berechne, habe aber auch keine Idee woher ich die Positionsdaten der Sensoren erhalte.
Hier noch meine Roboterklasse...
Java:
/*
* To change this license header, choose License Headers in Project Properties.
* To change this template file, choose Tools | Templates
* and open the template in the editor.
*/
package javaapplication7;

import java.awt.Color;
import java.awt.Dimension;
import java.awt.Graphics;
import java.awt.Point;
import java.awt.geom.Line2D;
import java.util.ArrayList;
import javax.swing.JInternalFrame;
import javax.swing.JPanel;
import javax.vecmath.Point3d;
import simbad.sim.*;
import javax.vecmath.Vector3d;
import simbad.gui.Simbad;
import java.awt.BasicStroke;
import java.awt.Graphics2D;
import static java.lang.Math.cos;
import static java.lang.Math.sin;

public class MyRobot extends Agent {

    public final static int ARENA_WIDTH = 9; //lenght of the arena
    public final static int ARENA_HEIGHT = 9; // width of the arena
    Point point1 = null, point2 = null;
    Point obstacle = null;
    Point3d coords;
    ArrayList<Line2D.Double> lines;
    ArrayList<Line2D.Double> obstacleLines;
    RangeSensorBelt sonars, bumpers;
    SensorMatrix luminanceMatrix;
    CameraSensor camera;
    TrackPanel panel;
    JInternalFrame statPanel;
    Simbad sframe;

    public MyRobot(Vector3d position, String name) {

        super(position, name);

        bumpers = RobotFactory.addBumperBeltSensor(this);
        sonars = RobotFactory.addSonarBeltSensor(this, 24);
        camera = RobotFactory.addCameraSensor(this);
        // prepare a buffer for storing gray level image
        luminanceMatrix = camera.createCompatibleSensorMatrix();
        panel = new TrackPanel();
        Dimension dim = new Dimension(ARENA_WIDTH * 70, ARENA_HEIGHT * 70);
        panel.setPreferredSize(dim);
        panel.setMinimumSize(dim);
        this.statPanel = new JInternalFrame();
        statPanel.add(panel);
        coords = new Point3d();
        getCoords(coords);
        point1 = new Point();
        point1.setLocation((coords.x + ARENA_WIDTH) * 70 / 2, (coords.z + ARENA_HEIGHT) * 70 / 2);
        lines = new ArrayList<>();
        obstacleLines = new ArrayList<>();

    }

    /**
     *
     * @param frame
     */
    public void setTrackViewFrame(JInternalFrame frame) {
        frame.add(panel);
        frame.setLocation(725, 20);
        frame.setSize(ARENA_WIDTH * 70, ARENA_HEIGHT * 70);
    }

    class TrackPanel extends JPanel {

        private static final long serialVersionUID = 1L;

        @Override
        protected void paintComponent(Graphics g) {
            int width = ARENA_WIDTH * 70;
            int height = ARENA_HEIGHT * 70;
            super.paintComponent(g);
            Graphics2D g2 = (Graphics2D) g;
            g2.setColor(Color.BLACK);
            g2.fillRect(0, 0, width, height);
           
            g2.setStroke(new BasicStroke(15.0f, // Line width
                    BasicStroke.CAP_ROUND, // End-cap style
                    BasicStroke.JOIN_ROUND)); // Vertex join style
            for (int y = 0; y < lines.size(); y++) {
                if (lines.get(0) != null) {
                    g2.drawLine((int) lines.get(y).x1,
                            (int) lines.get(y).y1,
                            (int) lines.get(y).x2,
                            (int) lines.get(y).y2);

                }
                 g2.setColor(Color.RED);
                 g2.setStroke(new BasicStroke(5.0f)); // Vertex join style
                  for (int x = 0; x < obstacleLines.size(); x++) {
                    
              
                if (obstacleLines.get(0) != null) {
                    g2.drawLine((int) obstacleLines.get(x).x1,
                            (int) obstacleLines.get(x).y1,
                            (int) obstacleLines.get(x).x2,
                            (int) obstacleLines.get(x).y2);
                }
                }
                  g2.setStroke(new BasicStroke(15.0f, // Line width
                    BasicStroke.CAP_ROUND, // End-cap style
                    BasicStroke.JOIN_ROUND)); // Vertex join style
                  g2.setColor(Color.WHITE);
                 
            }

        }
    }
//
    public void setObstacle() {
       getCoords(coords);
         for (int i = 0; i < sonars.getNumSensors(); i++) {
                double range = sonars.getMeasurement(i);
                double angle = sonars.getSensorAngle(i);
                boolean hit = sonars.hasHit(i);
                System.out.println("Sonar at angle " + angle
                        + "measured range =" + range + " has hit something:" + hit);
                if (hit ==true) {
                    obstacle = new Point();
                  
                      obstacle.setLocation((coords.x + ARENA_WIDTH ) * 70 / 2+ range *cos(angle) , (coords.z + ARENA_HEIGHT) * 70 / 2+ range *sin(angle));
               Line2D.Double obstLine = new Line2D.Double();
            obstLine.setLine( obstacle,  obstacle);
            obstacleLines.add(obstLine);
            hit = false;
                }
         }
    }

    @Override
    public void performBehavior() {

        if (bumpers.oneHasHit()) {
            setTranslationalVelocity(-0.1);
            setRotationalVelocity(0.1 * Math.random());

        } else // Front left obstacle ?
        if (sonars.hasHit(0) && (sonars.hasHit(1))) {
            setObstacle();
            setRotationalVelocity(-Math.PI / 4);
            setTranslationalVelocity(0.1);
        } // Front right obstacle ?
        else if (sonars.hasHit(0) && (sonars.hasHit(23))) {
            setObstacle();
            setRotationalVelocity(Math.PI / 4);
            setTranslationalVelocity(0.1);
        } // left obstacle ?
        else if (sonars.hasHit(3) || sonars.hasHit(4)) {
            setObstacle();
            setRotationalVelocity(-Math.PI / 8);
            setTranslationalVelocity(0.1);
        } // right obstacle ?
        else if (sonars.hasHit(21) || sonars.hasHit(20)) {
            setObstacle();
            setRotationalVelocity(Math.PI / 8);
            setTranslationalVelocity(0.1);
        } else if ((getCounter() % 100) == 0) {
            setRotationalVelocity(Math.PI / 2 * (0.5 - Math.random()));
            setTranslationalVelocity(0.5);
        }
       
        camera.copyVisionImage(luminanceMatrix);
        if (getCounter() % 10 == 0) {
            getCoords(coords);
            point2 = new Point();
            point2.setLocation((coords.x + ARENA_WIDTH) * 70 / 2, (coords.z + ARENA_HEIGHT) * 70 / 2);
            Line2D.Double newLine = new Line2D.Double();
            newLine.setLine(point1, point2);
            lines.add(newLine);
            panel.repaint();
            point1.x = point2.x;
            point1.y = point2.y;
        }
        //every 20 frames
        if (getCounter() % 20 == 0) {
            // print each sonars measurement
            for (int i = 0; i < sonars.getNumSensors(); i++) {
                double range = sonars.getMeasurement(i);
                double angle = sonars.getSensorAngle(i);
                boolean hit = sonars.hasHit(i);
                System.out.println("Sonar at angle " + angle
                        + "measured range =" + range + " has hit something:" + hit);
              
            }
        }
    }
}
 
Ähnliche Java Themen
  Titel Forum Antworten Datum
m1602 Hamster Simulator Aufgabenhilfe Java Basics - Anfänger-Themen 16
K Java Hamster Simulator Java Basics - Anfänger-Themen 18
S Hamster Simulator rechnen lernen Parameter int Java Basics - Anfänger-Themen 6
C Hamster Simulator Problem Java Basics - Anfänger-Themen 2
D Methoden Java Hamster Simulator / returnValue Java Basics - Anfänger-Themen 2
F Bewegungs-Simulator mit Startschwierigkeiten Java Basics - Anfänger-Themen 3
D Rekursions Probleme / frage Java Basics - Anfänger-Themen 4
P JDK installieren Probleme bei der Java-Installation Java Basics - Anfänger-Themen 8
C Probleme mit Byte konvertieren nach int Java Basics - Anfänger-Themen 10
P Probleme mit NetBeans: Wie lässt sich jar. Datei an einem MacBook öffnen Java Basics - Anfänger-Themen 21
I Projekte in IDE untereinander sharen / Probleme beim Build Java Basics - Anfänger-Themen 8
MiMa Probleme mit Datentyp long ?? Java Basics - Anfänger-Themen 2
T Probleme beim Import eines Git-Repos Java Basics - Anfänger-Themen 2
Jxhnny.lpz TicTacToe Spiel vs Computer. (Probleme) Java Basics - Anfänger-Themen 7
B Quiz mit RMI Probleme mit RMI start Java Basics - Anfänger-Themen 4
httprt Probleme bei dem erstellen von leveln in meinem Spiel Java Basics - Anfänger-Themen 2
berserkerdq2 Habe eine Klasse, welche public ist, diese hat eine public Methode, die nicht static ist. Wenn ich nun versuche aufzurufen Probleme? Java Basics - Anfänger-Themen 8
V Probleme Guessing Game Java Basics - Anfänger-Themen 8
hebein PDF Ausdruck auf Drucker - Probleme mit Format Java Basics - Anfänger-Themen 17
R JMenu/JMenuItem Probleme Java Basics - Anfänger-Themen 2
B Static vs non static und Probleme daraus Java Basics - Anfänger-Themen 13
J Probleme mit dem Debugger Java Basics - Anfänger-Themen 4
I Probleme mit OutputStream - Datei lässt sich nicht öffnen Java Basics - Anfänger-Themen 4
J Probleme mit Kompilierung Java Basics - Anfänger-Themen 11
B Probleme mit Zugriff auf Dateisystem Windows 10 ( jFileChooser) Java Basics - Anfänger-Themen 17
W Objekte über Scanner Input; ToString Probleme... Java Basics - Anfänger-Themen 4
C Probleme mit paintComponent Java Basics - Anfänger-Themen 13
P Probleme mit JUnit-Tests, es kommt was anderes raus als bei manuellen Tests Java Basics - Anfänger-Themen 5
E JavaFX Editor Probleme mit der Zwischenablage Java Basics - Anfänger-Themen 12
C Probleme mit dem Erstellen und Importieren von Packages Java Basics - Anfänger-Themen 6
3 OOP erste Versuche, OOP zu verstehen. Probleme mit gettern und settern Java Basics - Anfänger-Themen 4
R Erste Schritte Probleme bei 2D Spielfeld, mit einzufügender "Person" Java Basics - Anfänger-Themen 5
P Probleme bei der Installation von JavaFX Java Basics - Anfänger-Themen 3
S Mehrere Probleme im Code Java Basics - Anfänger-Themen 7
D Probleme mit JFrame und der Größe Java Basics - Anfänger-Themen 8
Dimax String Probleme Java Basics - Anfänger-Themen 12
N Probleme beim printen von Arrays durch for Schleife Java Basics - Anfänger-Themen 3
Splayfer Java Array Probleme Java Basics - Anfänger-Themen 3
J Probleme bei IllegalArgumentException "werfen". Java Basics - Anfänger-Themen 1
K Probleme bei der Ausgabe - komme nicht weiter :/ Java Basics - Anfänger-Themen 15
X Probleme im Umgang mit PriorityQueue Java Basics - Anfänger-Themen 75
D Probleme mit dem Windowbuilder und JComboBox Java Basics - Anfänger-Themen 2
M Regex Probleme (mal wieder) Java Basics - Anfänger-Themen 3
tom.j85 TicTacToe - probleme beim Casten Java Basics - Anfänger-Themen 6
J Probleme mit Vererbung Java Basics - Anfänger-Themen 4
X Probleme mit Übungsaufgaben zu Zahlentypen Java Basics - Anfänger-Themen 4
G Probleme bei Aufgabe Java Basics - Anfänger-Themen 12
P Erste Schritte Probleme mit dem Programmieren Java Basics - Anfänger-Themen 12
B Probleme bei einer Aufgabe Java Basics - Anfänger-Themen 19
Franzi1001 Probleme mit Eclipse Java Basics - Anfänger-Themen 7
T Probleme bei Installation von JDK Java Basics - Anfänger-Themen 2
C Probleme mit String-Vergleich Java Basics - Anfänger-Themen 4
C Probleme bei Regex Java Basics - Anfänger-Themen 9
V Probleme mit Arrays Java Basics - Anfänger-Themen 8
D Kleine Probleme mit Split-Befehlen Java Basics - Anfänger-Themen 5
T Probleme mit Strings Java Basics - Anfänger-Themen 6
G Probleme bei Frame aufgaben Java Basics - Anfänger-Themen 6
N Probleme mit dem ActionListener Java Basics - Anfänger-Themen 4
D Probleme beim Kompelieren mache ich etwas falsch ? Java Basics - Anfänger-Themen 3
L Probleme mit Java Java Basics - Anfänger-Themen 3
S Probleme mit abspielen einer .wav Datei Java Basics - Anfänger-Themen 2
J Probleme bei der Umwandlung einer Farbe von Hex zu RGB Java Basics - Anfänger-Themen 8
K Probleme beim Programm schreiben - Lesen von Dateiinhalten -zaehlen von Wörtern/ Buchstaben Java Basics - Anfänger-Themen 4
M Probleme beim aktualisieren eines JPanels Java Basics - Anfänger-Themen 7
J Probleme beim Array ausgeben Java Basics - Anfänger-Themen 4
M Probleme bei rekursiver Zuordnung Java Basics - Anfänger-Themen 1
I Probleme mit 2 dimensionale Arrays Java Basics - Anfänger-Themen 3
H Best Practice View probleme Java Basics - Anfänger-Themen 2
B Probleme mit Kreisberechnung Java Basics - Anfänger-Themen 15
E Probleme mit Scanner Java Basics - Anfänger-Themen 4
J Eclipse Export Probleme Java Basics - Anfänger-Themen 25
M Probleme beim verwenden von Packages Java Basics - Anfänger-Themen 6
D Probleme mit der Übergabe einer BorderPane Java Basics - Anfänger-Themen 2
J Interface Probleme bei der Implementierung Java Basics - Anfänger-Themen 1
BlueFox Tabelle in der Konsole ausgeben - Probleme Java Basics - Anfänger-Themen 1
G Methoden Probleme beim Methodenaufruf Java Basics - Anfänger-Themen 2
V Klassen ObjectInputStream ->ReadObject Probleme Java Basics - Anfänger-Themen 5
P Probleme mit der Do-Schleife Java Basics - Anfänger-Themen 2
F Erste Schritte Compiling Probleme Java Basics - Anfänger-Themen 13
S Neuling und Probleme bei Schulaufgabe Java Basics - Anfänger-Themen 5
J Anfänger: ActionListener und ProcessBuilder machen Probleme Java Basics - Anfänger-Themen 6
S Erste Schritte 2D Grafik Probleme mit KeyListener. Java Basics - Anfänger-Themen 18
M Array mit eigenem Datentyp probleme beim übergeben Java Basics - Anfänger-Themen 6
M Probleme mit Eclipse Java Basics - Anfänger-Themen 20
G Probleme beim casten von double zu int Java Basics - Anfänger-Themen 3
E 2 Probleme - Datum & private finale Variablen Java Basics - Anfänger-Themen 5
S Compiler-Fehler javac hat Probleme mit Paketen unter OSX Java Basics - Anfänger-Themen 2
J Probleme beim schreiben von Dateien Java Basics - Anfänger-Themen 5
B Variablen Probleme mit Eclipse Java Basics - Anfänger-Themen 6
H Mouse- und KeyListener Probleme? Java Basics - Anfänger-Themen 5
A Probleme beim zykl. aktulisieren von Daten in JTable Java Basics - Anfänger-Themen 3
I Probleme bei Verzeichnissanalyse Java Basics - Anfänger-Themen 12
F Probleme mit privaten Klassen (abstrakten Klassen) Java Basics - Anfänger-Themen 1
H Probleme mit Klassen...oder: Eine Uhr Java Basics - Anfänger-Themen 9
G Probleme mit Konsole Java Basics - Anfänger-Themen 4
S Probleme mit GamGrid Spiel-Erstellung => Actor reagiert nicht auf Tastatur Java Basics - Anfänger-Themen 2
G Probleme mit Eclipse oder der URL Klasse Java Basics - Anfänger-Themen 5
W Verständnis Probleme bei der while-Schleife und continue Java Basics - Anfänger-Themen 21
M Probleme mit Anzeigen von String in GUI und if-Anweisung Java Basics - Anfänger-Themen 9
T Konstruktor Probleme Java Basics - Anfänger-Themen 3

Ähnliche Java Themen

Neue Themen


Oben