add param for select test room
This commit is contained in:
@@ -9,6 +9,7 @@ import net.server.handlers.main.GetSonarData
|
|||||||
import net.server.handlers.main.SetRoute
|
import net.server.handlers.main.SetRoute
|
||||||
import net.server.handlers.main.SetRouteMetric
|
import net.server.handlers.main.SetRouteMetric
|
||||||
import net.server.handlers.rc.Control
|
import net.server.handlers.rc.Control
|
||||||
|
import room.Room
|
||||||
|
|
||||||
val carServerPort: Int = 8888
|
val carServerPort: Int = 8888
|
||||||
val mainServerPort = 7925
|
val mainServerPort = 7925
|
||||||
@@ -28,6 +29,9 @@ fun main(args: Array<String>) {
|
|||||||
when (arg) {
|
when (arg) {
|
||||||
"-t" -> runTests = true
|
"-t" -> runTests = true
|
||||||
"-e" -> runAsEmulator = true
|
"-e" -> runAsEmulator = true
|
||||||
|
"-tr1" -> Room.walls = Room.testRoom1()
|
||||||
|
"-tr2" -> Room.walls = Room.testRoom2()
|
||||||
|
"-tr3" -> Room.walls = Room.testRoom3()
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
val carController =
|
val carController =
|
||||||
|
|||||||
@@ -13,8 +13,8 @@ private fun testCarEmulator() {
|
|||||||
sonarResponse.mergeFrom(CodedInputStream(bytes))
|
sonarResponse.mergeFrom(CodedInputStream(bytes))
|
||||||
val dist0 = sonarResponse.distances[0]
|
val dist0 = sonarResponse.distances[0]
|
||||||
val dist90 = sonarResponse.distances[1]
|
val dist90 = sonarResponse.distances[1]
|
||||||
eq(dist0.toDouble(), Math.abs(Room.rightLine.C / Room.rightLine.A), "check angle 0", 2.5)
|
eq(dist0.toDouble(), 200.0, "check angle 0", 2.5)
|
||||||
eq(dist90.toDouble(), Room.bottomLine.C / Room.bottomLine.B, "check angle 90", 2.5)
|
eq(dist90.toDouble(), 20.0, "check angle 90", 2.5)
|
||||||
})
|
})
|
||||||
|
|
||||||
println("--------------------")
|
println("--------------------")
|
||||||
|
|||||||
@@ -5,6 +5,8 @@ import geometry.Line
|
|||||||
object Room {
|
object Room {
|
||||||
|
|
||||||
|
|
||||||
|
var walls = testRoom1()
|
||||||
|
|
||||||
/*
|
/*
|
||||||
_________
|
_________
|
||||||
| |
|
| |
|
||||||
@@ -13,61 +15,68 @@ object Room {
|
|||||||
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
val upLine = Line(0.0, 1.0, -300.0)
|
fun testRoom1(): List<Wall> {
|
||||||
val leftLine = Line(1.0, 0.0, 150.0)
|
val upLine = Line(0.0, 1.0, -300.0)
|
||||||
val bottomLine = Line(0.0, 1.0, 20.0)
|
val leftLine = Line(1.0, 0.0, 150.0)
|
||||||
val rightLine = Line(1.0, 0.0, -200.0)
|
val bottomLine = Line(0.0, 1.0, 20.0)
|
||||||
|
val rightLine = Line(1.0, 0.0, -200.0)
|
||||||
val walls = listOf<Wall>(Wall(upLine, 200, -150, 300, 300),
|
|
||||||
Wall(leftLine, -150, -150, 300, -20),
|
|
||||||
Wall(bottomLine, -150, 200, -20, -20),
|
|
||||||
Wall(rightLine, 200, 200, -20, 300)
|
|
||||||
)
|
|
||||||
|
|
||||||
|
|
||||||
/*
|
|
||||||
________
|
|
||||||
| |
|
|
||||||
| ___|
|
|
||||||
|___|
|
|
||||||
|
|
||||||
*/
|
|
||||||
// val upLine = Line(0.0, 1.0, -300.0)
|
|
||||||
// val leftLine = Line(1.0, 0.0, 150.0)
|
|
||||||
// val bottomLine = Line(0.0, 1.0, 20.0)
|
|
||||||
// val rightLine = Line(1.0, 0.0, -200.0)
|
|
||||||
//
|
//
|
||||||
// val bottomLine2 = Line(0.0, 1.0, -100.0)
|
val walls = listOf<Wall>(Wall(upLine, 200, -150, 300, 300),
|
||||||
// val rightLine2 = Line(1.0, 0.0, -300.0)
|
Wall(leftLine, -150, -150, 300, -20),
|
||||||
//
|
Wall(bottomLine, -150, 200, -20, -20),
|
||||||
// val walls = listOf<Wall>(Wall(upLine, 300, -150, 300, 300),
|
Wall(rightLine, 200, 200, -20, 300)
|
||||||
// Wall(leftLine, -150, -150, 300, -20),
|
)
|
||||||
// Wall(bottomLine, -150, 200, -20, -20),
|
return walls
|
||||||
// Wall(rightLine, 200, 200, -20, 100),
|
}
|
||||||
// Wall(bottomLine2, 200, 300, 100, 100),
|
|
||||||
// Wall(rightLine2, 300, 300, 100, 300)
|
|
||||||
// )
|
|
||||||
|
|
||||||
/*
|
fun testRoom2(): List<Wall> {
|
||||||
|
/*
|
||||||
|
________
|
||||||
|
| |
|
||||||
|
| ___|
|
||||||
|
|___|
|
||||||
|
|
||||||
_______
|
*/
|
||||||
| |
|
val upLine = Line(0.0, 1.0, -300.0)
|
||||||
|____/
|
val leftLine = Line(1.0, 0.0, 150.0)
|
||||||
|
val bottomLine = Line(0.0, 1.0, 20.0)
|
||||||
|
val rightLine = Line(1.0, 0.0, -200.0)
|
||||||
|
|
||||||
|
val bottomLine2 = Line(0.0, 1.0, -100.0)
|
||||||
|
val rightLine2 = Line(1.0, 0.0, -300.0)
|
||||||
|
|
||||||
|
val walls = listOf<Wall>(Wall(upLine, 300, -150, 300, 300),
|
||||||
|
Wall(leftLine, -150, -150, 300, -20),
|
||||||
|
Wall(bottomLine, -150, 200, -20, -20),
|
||||||
|
Wall(rightLine, 200, 200, -20, 100),
|
||||||
|
Wall(bottomLine2, 200, 300, 100, 100),
|
||||||
|
Wall(rightLine2, 300, 300, 100, 300)
|
||||||
|
)
|
||||||
|
return walls
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
*/
|
fun testRoom3(): List<Wall> {
|
||||||
|
/*
|
||||||
|
_______
|
||||||
|
| |
|
||||||
|
|____/
|
||||||
|
|
||||||
// val upLine = Line(0.0, 1.0, -300.0)
|
|
||||||
// val leftLine = Line(1.0, 0.0, 150.0)
|
*/
|
||||||
// val bottomLine = Line(0.0, 1.0, 20.0)
|
val upLine = Line(0.0, 1.0, -300.0)
|
||||||
// val rightLine = Line(-1.2, 1.0, 140.0)
|
val leftLine = Line(1.0, 0.0, 150.0)
|
||||||
// val rightLine2 = Line(1.0, 1.0, -350.0)
|
val bottomLine = Line(0.0, 1.0, 20.0)
|
||||||
//
|
val rightLine = Line(-1.2, 1.0, 140.0)
|
||||||
// val walls = listOf<Wall>(Wall(upLine, 200, -150, 300, 300),
|
val rightLine2 = Line(1.0, 1.0, -350.0)
|
||||||
// Wall(leftLine, -150, -150, 300, -20),
|
|
||||||
// Wall(bottomLine, -150, 100, -20, -20),
|
val walls = listOf<Wall>(Wall(upLine, 200, -150, 300, 300),
|
||||||
// Wall(rightLine, 100, 200, -20, 100),
|
Wall(leftLine, -150, -150, 300, -20),
|
||||||
// Wall(rightLine2, 200, 200, 100, 300)
|
Wall(bottomLine, -150, 100, -20, -20),
|
||||||
// )
|
Wall(rightLine, 100, 200, -20, 100),
|
||||||
|
Wall(rightLine2, 200, 200, 100, 300)
|
||||||
|
)
|
||||||
|
return walls
|
||||||
|
}
|
||||||
|
|
||||||
}
|
}
|
||||||
Reference in New Issue
Block a user