Add action to get world size from LiDAR

This commit is contained in:
Luc Lagarde 2018-03-28 23:34:23 -05:00
parent ff61433c4b
commit 217c997788

View File

@ -29,6 +29,7 @@ public class CubotLidar extends CpuHardware implements JSONSerialisable {
private static final int LIDAR_GET_PATH = 2;
private static final int LIDAR_GET_MAP = 3;
private static final int LIDAR_GET_WORLD_POS = 4;
private static final int LIDAR_GET_WORLD_SIZE = 5;
private static final int MEMORY_MAP_START = 0x0100;
private static final int MEMORY_PATH_START = 0x0000;
@ -122,6 +123,12 @@ public class CubotLidar extends CpuHardware implements JSONSerialisable {
}
break;
case LIDAR_GET_WORLD_SIZE:
getCpu().getRegisterSet().getRegister("X").setValue(cubot.getWorld().getWorldSize());
getCpu().getRegisterSet().getRegister("Y").setValue(cubot.getWorld().getWorldSize());
break;
case LIDAR_GET_WORLD_POS:
getCpu().getRegisterSet().getRegister("X").setValue(cubot.getWorld().getX());
getCpu().getRegisterSet().getRegister("Y").setValue(cubot.getWorld().getY());