import pl.edu.agh.amber.common.AmberClient;
import pl.edu.agh.amber.drivetopoint.DriveToPointProxy;
import pl.edu.agh.amber.drivetopoint.Location;
import pl.edu.agh.amber.drivetopoint.Point;
import pl.edu.agh.amber.drivetopoint.Result;

import java.io.IOException;
import java.util.Arrays;
import java.util.List;
import java.util.Scanner;

/**
 * Drive to point proxy example.
 *
 * @author Pawel Suder <pawel@suder.info>
 */
public class DriveToPointExample {

    public static void main(String[] args) {
        (new DriveToPointExample()).runDemo();
    }

    public void runDemo() {
        Scanner keyboard = new Scanner(System.in);
        System.out.print("IP (default: 127.0.0.1): ");
        String hostname = keyboard.nextLine();

        if ("".equals(hostname)) {
            hostname = "127.0.0.1";
        }

        AmberClient client;
        try {
            client = new AmberClient(hostname, 26233);

        } catch (IOException e) {
            System.out.println("Unable to connect to robot: " + e);
            return;
        }

        DriveToPointProxy driveToPointProxy = new DriveToPointProxy(client, 0);

        try {
            List<Point> targets = Arrays.asList(new Point(2447.25, 4221.25, 100.0),
                    new Point(1467.06, 4142.85, 100.0), new Point(673.888, 3769.64, 100.0),
                    new Point(473.391, 2967.81, 100.0));
            driveToPointProxy.setTargets(targets);

            while (true) {
                Result<List<Point>> resultNextTargets = driveToPointProxy.getNextTargets();
                Result<List<Point>> resultVisitedTargets = driveToPointProxy.getVisitedTargets();
                List<Point> nextTargets = resultNextTargets.getResult();
                List<Point> visitedTargets = resultVisitedTargets.getResult();
                System.out.println(String.format("next targets: %s, visited targets: %s", nextTargets.toString(), visitedTargets.toString()));
                Thread.sleep(1000);
            }

        } catch (IOException e) {
            System.out.println("Error in sending a command: " + e);
        } catch (Exception e) {
            e.printStackTrace();
        } finally {
            client.terminate();
        }
    }
}

@@ -1192,16 +1192,37 @@
 .asList(
+%0A                    
 new Poin
@@ -1228,30 +1228,29 @@
 nt(2
+.
 447
-.
 25, 4
+.
 221
-.
 25, 
-100.0
+0.25
 ),%0A 
@@ -1283,32 +1283,51 @@
 nt(1
+.
 467
-.
 06, 4
+.
 142
-.
 85, 
-100.0),
+0.25),%0A                   
  new
@@ -1337,31 +1337,30 @@
 int(
+0.
 673
-.88
 8
+9
 , 3
+.
 769
-.
 64, 
-100.0
+0.25
 ),%0A 
@@ -1392,31 +1392,30 @@
 int(
+0.
 473
-.
 39
-1
 , 2
+.
 967
-.
 81, 
-100.0
+0.25
 ));%0A

Use meters conversion