tile38/pkg/geojson/poly/raycast.go

96 lines
1.8 KiB
Go
Raw Normal View History

2016-03-05 02:08:16 +03:00
package poly
2016-12-04 18:57:54 +03:00
import "math"
2016-03-05 02:08:16 +03:00
2016-12-04 18:57:54 +03:00
type rayres struct {
in, on bool
2016-03-05 02:08:16 +03:00
}
func raycast(p, a, b Point) rayres {
2016-12-04 18:57:54 +03:00
// make sure that the point is inside the segment bounds
if a.Y < b.Y && (p.Y < a.Y || p.Y > b.Y) {
return rayres{false, false}
} else if a.Y > b.Y && (p.Y < b.Y || p.Y > a.Y) {
return rayres{false, false}
}
// test if point is in on the segment
2016-03-05 02:08:16 +03:00
if a.Y == b.Y {
if a.X == b.X {
2016-12-04 18:57:54 +03:00
if p == a {
return rayres{false, true}
} else {
return rayres{false, false}
2016-03-05 02:08:16 +03:00
}
}
2016-12-04 18:57:54 +03:00
if p.Y == b.Y {
// horizontal segment
// check if the point in on the line
if a.X < b.X {
if p.X >= a.X && p.X <= b.X {
return rayres{false, true}
}
} else {
if p.X >= b.X && p.X <= a.X {
return rayres{false, true}
}
2016-03-05 02:08:16 +03:00
}
}
}
2016-12-04 18:57:54 +03:00
if a.X == b.X && p.X == b.X {
// vertical segment
// check if the point in on the line
if a.Y < b.Y {
if p.Y >= a.Y && p.Y <= b.Y {
return rayres{false, true}
2016-03-05 02:08:16 +03:00
}
} else {
2016-12-04 18:57:54 +03:00
if p.Y >= b.Y && p.Y <= a.Y {
return rayres{false, true}
2016-03-05 02:08:16 +03:00
}
}
2016-12-04 18:57:54 +03:00
}
if (p.X-a.X)/(b.X-a.X) == (p.Y-a.Y)/(b.Y-a.Y) {
return rayres{false, true}
2016-03-05 02:08:16 +03:00
}
2016-12-04 18:57:54 +03:00
// do the actual raycast here.
for p.Y == a.Y || p.Y == b.Y {
p.Y = math.Nextafter(p.Y, math.Inf(1))
2016-03-05 02:08:16 +03:00
}
2016-12-04 18:57:54 +03:00
if a.Y < b.Y {
if p.Y < a.Y || p.Y > b.Y {
return rayres{false, false}
}
} else {
if p.Y < b.Y || p.Y > a.Y {
return rayres{false, false}
}
2016-03-05 02:08:16 +03:00
}
2016-12-04 18:57:54 +03:00
if a.X > b.X {
if p.X > a.X {
return rayres{false, false}
2016-03-05 02:08:16 +03:00
}
2016-12-04 18:57:54 +03:00
if p.X < b.X {
return rayres{true, false}
2016-03-05 02:08:16 +03:00
}
} else {
2016-12-04 18:57:54 +03:00
if p.X > b.X {
return rayres{false, false}
2016-03-05 02:08:16 +03:00
}
2016-12-04 18:57:54 +03:00
if p.X < a.X {
return rayres{true, false}
2016-03-05 02:08:16 +03:00
}
}
2016-12-04 18:57:54 +03:00
if a.Y < b.Y {
if (p.Y-a.Y)/(p.X-a.X) >= (b.Y-a.Y)/(b.X-a.X) {
return rayres{true, false}
}
} else {
if (p.Y-b.Y)/(p.X-b.X) >= (a.Y-b.Y)/(a.X-b.X) {
return rayres{true, false}
}
2016-03-05 02:08:16 +03:00
}
2016-12-04 18:57:54 +03:00
return rayres{false, false}
2016-03-05 02:08:16 +03:00
}