robocars/robocar-steering
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

feat: object filter on car parts

Browse Source
This commit is contained in:
Cyrille Nofficial 2024-01-16 21:06:11 +01:00
parent 67dc92e476
commit 8e6b7edec9
1 changed files with 11 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

11
pkg/steering/corrector.go
View File

@ -140,6 +140,7 @@ AdjustFromObjectPosition modify steering value according object positions
*/
func (c *GridCorrector) AdjustFromObjectPosition(currentSteering float64, objs []*events.Object) float64 {
objects := c.filter_big_objects(objs, c.imgWidth, c.imgHeight, c.sizeThreshold)
objects = c.filter_bottom_images(objects)
zap.S().Debugf("%v objects to avoid", len(objects))
if len(objects) == 0 {
@ -234,6 +235,16 @@ func (c *GridCorrector) filter_big_objects(objts []*events.Object, imgWidth int,
return objectFiltred
}
func (c *GridCorrector) filter_bottom_images(objts []*events.Object) []*events.Object {
objectFiltred := make([]*events.Object, 0, len(objts))
for _, o := range objts {
if o.Top > 0.90 {
objectFiltred = append(objectFiltred, o)
}
}
return objectFiltred
}
func NewGridMapFromJson(fileName string) (*GridMap, error) {
content, err := os.ReadFile(fileName)
if err != nil {