-
-
Notifications
You must be signed in to change notification settings - Fork 76
Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
- Loading branch information
1 parent
54d301a
commit 1ccfffd
Showing
3 changed files
with
217 additions
and
23 deletions.
There are no files selected for viewing
172 changes: 172 additions & 0 deletions
172
app/src/main/java/com/kylecorry/trail_sense/tools/augmented_reality/ARLineLayer.kt
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| Original file line number | Diff line number | Diff line change |
|---|---|---|
| @@ -0,0 +1,172 @@ | ||
| package com.kylecorry.trail_sense.tools.augmented_reality | ||
|
|
||
| import android.graphics.Color | ||
| import android.graphics.Path | ||
| import androidx.annotation.ColorInt | ||
| import com.kylecorry.andromeda.canvas.ICanvasDrawer | ||
| import com.kylecorry.andromeda.core.units.PixelCoordinate | ||
| import com.kylecorry.sol.math.SolMath | ||
| import com.kylecorry.sol.math.SolMath.normalizeAngle | ||
| import com.kylecorry.trail_sense.tools.augmented_reality.position.ARPositionStrategy | ||
| import kotlin.math.hypot | ||
| import kotlin.math.min | ||
| import kotlin.math.roundToInt | ||
|
|
||
| // TODO: Create a generic version of this that works like the path tool. The consumers should be able to specify the line style, color, thickness, and whether it should be curved or straight between points | ||
| class ARLineLayer( | ||
| @ColorInt private val color: Int = Color.WHITE, | ||
| private val thicknessDp: Float = 1f | ||
| ) : ARLayer { | ||
|
|
||
| private val path = Path() | ||
|
|
||
| private val lines = mutableListOf<List<ARPositionStrategy>>() | ||
| private val lineLock = Any() | ||
|
|
||
| fun setLines(lines: List<List<ARPositionStrategy>>) { | ||
| synchronized(lineLock) { | ||
| this.lines.clear() | ||
| this.lines.addAll(lines) | ||
| } | ||
| } | ||
|
|
||
| fun clearLines() { | ||
| synchronized(lineLock) { | ||
| lines.clear() | ||
| } | ||
| } | ||
|
|
||
| override fun draw(drawer: ICanvasDrawer, view: AugmentedRealityView) { | ||
| val maxAngle = hypot(view.fov.width, view.fov.height) * 1.5f | ||
| val resolutionDegrees = (maxAngle / 10f).roundToInt().coerceIn(1, 5) | ||
|
|
||
| drawer.noFill() | ||
| drawer.strokeWeight(drawer.dp(thicknessDp)) | ||
|
|
||
| val maxDistance = min(view.width, view.height) | ||
| // TODO: Divide up the line into smaller chunks | ||
|
|
||
| val lines = synchronized(lineLock) { | ||
| lines.toList() | ||
| } | ||
|
|
||
| // Draw horizontal lines | ||
| for (line in lines) { | ||
| path.reset() | ||
| drawer.stroke(color) | ||
| val pixels = getLinePixels( | ||
| view, | ||
| line, | ||
| resolutionDegrees.toFloat(), | ||
| maxDistance.toFloat() | ||
| ) | ||
| // TODO: This should clip the lines to the view, just like | ||
| for (pixelLine in pixels) { | ||
| var previous: PixelCoordinate? = null | ||
| for (pixel in pixelLine) { | ||
| if (previous != null) { | ||
| path.lineTo(pixel.x, pixel.y) | ||
| } else { | ||
| path.moveTo(pixel.x, pixel.y) | ||
| } | ||
| previous = pixel | ||
| } | ||
| } | ||
|
|
||
| drawer.path(path) | ||
| } | ||
|
|
||
| drawer.noStroke() | ||
| } | ||
|
|
||
| /** | ||
| * Given a line it returns the pixels that make up the line. | ||
| * It will split long lines into smaller chunks, using the resolutionDegrees. | ||
| * It will also clip the line to the view. | ||
| */ | ||
| private fun getLinePixels( | ||
| view: AugmentedRealityView, | ||
| line: List<ARPositionStrategy>, | ||
| resolutionDegrees: Float, | ||
| maxDistance: Float, | ||
| ): List<List<PixelCoordinate>> { | ||
| val pixels = mutableListOf<PixelCoordinate>() | ||
| var previousCoordinate: AugmentedRealityView.HorizonCoordinate? = null | ||
| for (point in line) { | ||
| val coord = point.getHorizonCoordinate(view) | ||
| pixels.addAll(if (previousCoordinate != null) { | ||
| splitLine(previousCoordinate, coord, resolutionDegrees).map { view.toPixel(it) } | ||
| } else { | ||
| listOf(view.toPixel(coord)) | ||
| }) | ||
|
|
||
| previousCoordinate = coord | ||
| } | ||
|
|
||
|
|
||
| // If there are any points that are further apart than maxDistance, split them up | ||
| val splitPixels = mutableListOf<List<PixelCoordinate>>() | ||
| var previousPixel: PixelCoordinate? = null | ||
| var currentLine = mutableListOf<PixelCoordinate>() | ||
| for (pixel in pixels) { | ||
| if (previousPixel != null && pixel.distanceTo(previousPixel) > maxDistance) { | ||
| splitPixels.add(currentLine) | ||
| currentLine = mutableListOf() | ||
| } | ||
| currentLine.add(pixel) | ||
| previousPixel = pixel | ||
| } | ||
| if (currentLine.isNotEmpty()) { | ||
| splitPixels.add(currentLine) | ||
| } | ||
|
|
||
| // Clip the lines to the view | ||
| return splitPixels.filter { line -> | ||
| line.isNotEmpty() | ||
| } | ||
| } | ||
|
|
||
| // TODO: Should this operate on pixels or coordinates? - if it is pixels, it will be linear, if it is coordinates it will be curved | ||
| private fun splitLine( | ||
| start: AugmentedRealityView.HorizonCoordinate, | ||
| end: AugmentedRealityView.HorizonCoordinate, | ||
| resolutionDegrees: Float | ||
| ): List<AugmentedRealityView.HorizonCoordinate> { | ||
| val coordinates = mutableListOf<AugmentedRealityView.HorizonCoordinate>() | ||
| coordinates.add(start) | ||
| val bearingDelta = SolMath.deltaAngle(start.bearing, end.bearing) | ||
| val elevationDelta = end.elevation - start.elevation | ||
| val distanceDelta = end.distance - start.distance | ||
| val distance = hypot(bearingDelta, elevationDelta) | ||
| val steps = (distance / resolutionDegrees).roundToInt() | ||
| val bearingStep = bearingDelta / steps | ||
| val elevationStep = elevationDelta / steps | ||
| val distanceStep = distanceDelta / steps | ||
| for (i in 1..steps) { | ||
| coordinates.add( | ||
| AugmentedRealityView.HorizonCoordinate( | ||
| normalizeAngle(start.bearing + bearingStep * i), | ||
| start.elevation + elevationStep * i, | ||
| start.distance + distanceStep * i | ||
| ) | ||
| ) | ||
| } | ||
| return coordinates | ||
| } | ||
|
|
||
| override fun invalidate() { | ||
| // Do nothing | ||
| } | ||
|
|
||
| override fun onClick( | ||
| drawer: ICanvasDrawer, | ||
| view: AugmentedRealityView, | ||
| pixel: PixelCoordinate | ||
| ): Boolean { | ||
| return false | ||
| } | ||
|
|
||
| override fun onFocus(drawer: ICanvasDrawer, view: AugmentedRealityView): Boolean { | ||
| return false | ||
| } | ||
| } |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters