Fix/defence parameter - #103
Conversation
There was a problem hiding this comment.
Pull request overview
Adjusts goalkeeper/defender positioning logic to better handle blocked shooting lanes and reduce unnecessary defender movement when the ball is likely being passed rather than shot.
Changes:
- Updates
goalkeepto conditionally compute a fallbackstop_ybased on defender positions. - Updates
defend_parameterto use ball-position prediction at specific x-coordinates to decide when to block. - Tweaks defender approach vector computation (currently introduces a likely error).
Reviewed changes
Copilot reviewed 2 out of 2 changed files in this pull request and generated 4 comments.
| File | Description |
|---|---|
utama_core/skills/src/goalkeep.py |
Adds guards before using defender/ball geometry to set goalkeeper fallback positioning. |
utama_core/skills/src/defend_parameter.py |
Uses predicted ball path to decide when defender should commit to a blocking point, and adjusts target offset computation. |
Co-authored-by: Copilot <175728472+Copilot@users.noreply.github.com>
|
@NingchuanIC I've opened a new pull request, #104, to work on those changes. Once the pull request is ready, I'll request review from you. |
|
@NingchuanIC I've opened a new pull request, #105, to work on those changes. Once the pull request is ready, I'll request review from you. |
* Initial plan * Fix defender position logic for left/right goal defense Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com> --------- Co-authored-by: copilot-swe-agent[bot] <198982749+Copilot@users.noreply.github.com> Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com>
* Initial plan * Fix: Make defender position check side-aware Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com> --------- Co-authored-by: copilot-swe-agent[bot] <198982749+Copilot@users.noreply.github.com> Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com> Co-authored-by: Fred Huang <60901360+fred-huang122@users.noreply.github.com>
| ball_y_at_baseline = predict_ball_pos_at_x(game, 4.5 if game.my_team_is_right else -4.5) | ||
| ball_y_at_robo = predict_ball_pos_at_x(game, defenseing_friendly.p.x) | ||
| if ( | ||
| vel[0] ** 2 + vel[1] ** 2 > 0.05 | ||
| and (ball_y_at_baseline is not None and ball_y_at_baseline[1] < 0.5 and ball_y_at_baseline[1] > -0.5) | ||
| and ( | ||
| ball_y_at_robo is not None | ||
| and abs(ball_y_at_robo[1] - defenseing_friendly.p.y) > 0.1 | ||
| ) | ||
| ): |
There was a problem hiding this comment.
The predict_ball_pos_at_x function can return None when ball velocity is zero or when ux is zero. While the code checks for None, there's a dependency on the predict_ball_pos_at_x implementation which has a logical issue: it returns None when either vel[0] or vel[1] is zero, and returns the current ball position when uy is 0. This means horizontally-moving balls (uy ≈ 0) might not be properly predicted, potentially causing defenders to not block shots moving primarily in the x-direction. Consider adding additional checks or using a more robust prediction method.
| try: | ||
| _, yy1 = intersection_with_vertical_line( | ||
| (game.ball.p.x, game.ball.p.y), (game.friendly_robots[1].p.x, game.friendly_robots[1].p.y + 0.1) | ||
| # Check if both defenders are between ball and goal (side-aware) | ||
| defender1_between = ( | ||
| (game.my_team_is_right and game.friendly_robots[1].p.x > game.ball.p.x) or | ||
| (not game.my_team_is_right and game.friendly_robots[1].p.x < game.ball.p.x) |
There was a problem hiding this comment.
The condition only checks if defenders are between the ball and goal in the x-dimension, regardless of their y-coordinates. This means a defender far from the ball's trajectory (large y-difference) will still affect the goalkeeper's stop_y calculation. While the intersection_with_vertical_line function accounts for trajectory, using defenders that are significantly off the ball's path might result in suboptimal goalkeeper positioning. Consider adding a check to ensure defenders are within a reasonable y-distance from the ball before including them in the calculation.
| # Check if defender is between ball and goal (side-aware) | ||
| defender_between = ( | ||
| (game.my_team_is_right and game.friendly_robots[1].p.x > game.ball.p.x) or | ||
| (not game.my_team_is_right and game.friendly_robots[1].p.x < game.ball.p.x) | ||
| ) | ||
| stop_y = (yy + 0.5) / 2 | ||
| if defender_between: | ||
| _, yy = intersection_with_vertical_line( | ||
| (game.ball.p.x, game.ball.p.y), (game.friendly_robots[1].p.x, game.friendly_robots[1].p.y + 0.1) | ||
| ) | ||
| stop_y = (yy + 0.5) / 2 | ||
| except (IndexError, KeyError): | ||
| # If robot with ID 1 is not available, keep default stop_y | ||
| pass | ||
| elif len(game.friendly_robots) >= 3: | ||
| try: | ||
| _, yy1 = intersection_with_vertical_line( | ||
| (game.ball.p.x, game.ball.p.y), (game.friendly_robots[1].p.x, game.friendly_robots[1].p.y + 0.1) | ||
| # Check if both defenders are between ball and goal (side-aware) | ||
| defender1_between = ( | ||
| (game.my_team_is_right and game.friendly_robots[1].p.x > game.ball.p.x) or | ||
| (not game.my_team_is_right and game.friendly_robots[1].p.x < game.ball.p.x) |
There was a problem hiding this comment.
The new goalkeeper logic that determines when to adjust stop_y based on defender positions is not covered by tests. Given that this code handles critical defensive positioning and includes conditional logic for different team orientations, it should have test coverage to verify behavior for both game.my_team_is_right = True and False cases. Following the pattern seen in utama_core/tests/skills/test_find_best_shot.py, consider adding similar tests for this functionality.
| if ( | ||
| vel[0] ** 2 + vel[1] ** 2 > 0.05 | ||
| and (ball_y_at_baseline is not None and ball_y_at_baseline[1] < 0.5 and ball_y_at_baseline[1] > -0.5) | ||
| and ( |
There was a problem hiding this comment.
The condition checks if the ball will reach within the goal frame (between -0.5 and 0.5 y-coordinate) at the baseline. However, the logic only triggers defensive movement if this condition is true. This means that if the ball trajectory predicts it will miss the goal (outside the -0.5 to 0.5 range), the defender won't attempt to block it, even if the ball might be deflected or if the prediction is uncertain. Consider whether defenders should still maintain blocking positions for near-misses or add a margin to the goal frame check.
| if ( | |
| vel[0] ** 2 + vel[1] ** 2 > 0.05 | |
| and (ball_y_at_baseline is not None and ball_y_at_baseline[1] < 0.5 and ball_y_at_baseline[1] > -0.5) | |
| and ( | |
| goal_margin = 0.1 | |
| if ( | |
| vel[0] ** 2 + vel[1] ** 2 > 0.05 | |
| and ( | |
| ball_y_at_baseline is not None | |
| and -0.5 - goal_margin < ball_y_at_baseline[1] < 0.5 + goal_margin | |
| ) | |
| and ( |
| ball_y_at_baseline = predict_ball_pos_at_x(game, 4.5 if game.my_team_is_right else -4.5) | ||
| ball_y_at_robo = predict_ball_pos_at_x(game, defenseing_friendly.p.x) | ||
| if ( | ||
| vel[0] ** 2 + vel[1] ** 2 > 0.05 | ||
| and (ball_y_at_baseline is not None and ball_y_at_baseline[1] < 0.5 and ball_y_at_baseline[1] > -0.5) | ||
| and ( | ||
| ball_y_at_robo is not None | ||
| and abs(ball_y_at_robo[1] - defenseing_friendly.p.y) > 0.1 | ||
| ) | ||
| ): |
There was a problem hiding this comment.
The new conditional logic that determines when defenders should move to block shots lacks test coverage. This code includes multiple complex conditions (ball velocity, predicted positions, distance thresholds) and has a critical bug in the vector calculation (line 84). Tests should verify the defender behavior in various scenarios: balls moving toward goal, balls moving away from goal, balls at different velocities, and defenders at different positions. Following the pattern in utama_core/tests/skills/test_find_best_shot.py, consider adding comprehensive test coverage.
* Fix: fix the goalkeeper and defencer * fix: the robot will not move if it block the ball * Fix: the robot will not move if it block the path * Update utama_core/skills/src/defend_parameter.py Co-authored-by: Copilot <175728472+Copilot@users.noreply.github.com> * Fix goalkeeper defender position logic for left goal defense (#104) * Initial plan * Fix defender position logic for left/right goal defense Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com> --------- Co-authored-by: copilot-swe-agent[bot] <198982749+Copilot@users.noreply.github.com> Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com> * Fix side-aware defender position check in goalkeeper logic (#105) * Initial plan * Fix: Make defender position check side-aware Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com> --------- Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com> --------- Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com> Co-authored-by: Fred Huang <60901360+fred-huang122@users.noreply.github.com>
* the dwa is cooked it runs in sim but the robots are undergoing brownian motion * Fast Path PLanning * fixing * cleaning up * test: write simple straight line test * test: uncomment straight line test with obstacles * test: moving robots obstacle course, also added separate motion controller for opponents for testing * test: implement unit test of 12 robots dashing straight at each other * test: implement test with 6 robots moving randomly in a half court * fixing a bug * increased safety * revert dwa config and planner * rename test file * fixing slowing down at sugoals + linting * recursion error fix * fix: index out of order bug * updates to fastpathplanning * updates * updating * adding test * random movement test succeeds with fpp (5 robots) * diagonal robot movement test pass with fpp * make number of robots in random_movement_test adjustable * use fpp in all tests * reduce to 3 robots in random_movement_test * compute distance between two line segments * g * Lined Based obstacles and Config Files Updates * fixed issues concerning new functions in math_utils * updating * Removing extra libraries * Update utama_core/motion_planning/src/fastpathplanning/planner.py Co-authored-by: Copilot <175728472+Copilot@users.noreply.github.com> * Adding snake eye convention and removing unwanted code * Removed target from collide function * Updating checksegment function * Including Joel's suggestions * snake_case and parameter error fix * Update utama_core/motion_planning/src/controllers/fastpathplanning.py Co-authored-by: Copilot <175728472+Copilot@users.noreply.github.com> * Fix/goalkeeping (#92) * dribbling * improved logic * bug fix * updates * improvements * typing * optimizations to rsim * Update utama_core/rsoccer_simulator/src/ssl/envs/standard_ssl.py Co-authored-by: Copilot <175728472+Copilot@users.noreply.github.com> * bug fixes + updates * linting * test bug fix * test_fix * undo * undo * reverted params * bug fixes * improved dribbler logic * Update utama_core/team_controller/src/controllers/real/real_robot_controller.py Co-authored-by: Copilot <175728472+Copilot@users.noreply.github.com> * updates * update fix * updates * updates * fixes * removed prints * feat: change goalkeep * feat: fix bug * add change * Fix: fix the bug run toward enemy * Fix: add a barrier to the forbiden square * Fix: goal keep * simplification of similar codes * simplification * minor: improve in algo * minor: improve in algo * fix: algorithm problem * Fix: write the algorithm that let goalkeeper go between predict line and other robo * Feat: add the third defender * Fix: better tribble defender * chore: linting * Update utama_core/skills/src/goalkeep.py Co-authored-by: Copilot <175728472+Copilot@users.noreply.github.com> * Update utama_core/skills/src/defend_parameter.py Co-authored-by: Copilot <175728472+Copilot@users.noreply.github.com> * Update utama_core/skills/src/defend_parameter.py Co-authored-by: Copilot <175728472+Copilot@users.noreply.github.com> * Remove unused imports from defend_parameter.py (#100) * Initial plan * Remove unused imports face_ball and move Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com> --------- Co-authored-by: copilot-swe-agent[bot] <198982749+Copilot@users.noreply.github.com> Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com> * Fix goalkeep to handle teams with more than 3 robots (#99) * Initial plan * Fix: handle cases with more than 3 friendly robots in goalkeep Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com> --------- Co-authored-by: copilot-swe-agent[bot] <198982749+Copilot@users.noreply.github.com> Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com> * Remove dead code file goal_keep.py (#98) * Initial plan * Remove dead code file goal_keep.py Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com> --------- Co-authored-by: copilot-swe-agent[bot] <198982749+Copilot@users.noreply.github.com> Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com> * Remove unused math import from standard_ssl.py (#97) * Initial plan * Remove unused math import from standard_ssl.py Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com> --------- Co-authored-by: copilot-swe-agent[bot] <198982749+Copilot@users.noreply.github.com> Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com> * Fix hardcoded goal coordinates in defend_parameter.py for bidirectional play (#96) * Initial plan * Fix hardcoded goal x-coordinates in defend_parameter.py Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com> --------- Co-authored-by: copilot-swe-agent[bot] <198982749+Copilot@users.noreply.github.com> Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com> Co-authored-by: Fred Huang <60901360+fred-huang122@users.noreply.github.com> --------- Co-authored-by: Fred Huang <fredhuang122106@gmail.com> Co-authored-by: Fred Huang <60901360+fred-huang122@users.noreply.github.com> Co-authored-by: Copilot <175728472+Copilot@users.noreply.github.com> Co-authored-by: Isaac Yong <72080621+isaac0804@users.noreply.github.com> Co-authored-by: Yangping Li <lynfe@LAPTOP-JJF6AK12.localdomain> Co-authored-by: Ningchaun <1311856651@qq.com> Co-authored-by: Copilot <198982749+Copilot@users.noreply.github.com> Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com> * chore(release): bump version to v1.5.20 * Real/extend kick transmission (#93) * chore(release): bump version to v1.5.21 * Add DeepWiki badge to README Add badge for DeepWiki to README * Feature/rsim noise (#89) * Implemented a flag to add Gaussian noise in rsim. Added another more hackish implementation for comparison. * Cleaned up implementation, removed hackish alternative * Working on adding noise to each component independently * Completed implementation of noise addition * Addressed comments on PR, got orientation to work * Addressed comments in PR, added vanishing, added support for ball * Minor linting * Moved utility functions for adding Gaussian noise from classes representing balls/robots to the SSLStdenv class. Learned about this best practice in this week's lecture * Turned off a flag used for testing --------- Co-authored-by: Joel <42647510+energy-in-joles@users.noreply.github.com> * chore(release): bump version to v1.6.0 * Fix/defence parameter (#103) * Fix: fix the goalkeeper and defencer * fix: the robot will not move if it block the ball * Fix: the robot will not move if it block the path * Update utama_core/skills/src/defend_parameter.py Co-authored-by: Copilot <175728472+Copilot@users.noreply.github.com> * Fix goalkeeper defender position logic for left goal defense (#104) * Initial plan * Fix defender position logic for left/right goal defense Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com> --------- Co-authored-by: copilot-swe-agent[bot] <198982749+Copilot@users.noreply.github.com> Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com> * Fix side-aware defender position check in goalkeeper logic (#105) * Initial plan * Fix: Make defender position check side-aware Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com> --------- Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com> --------- Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com> Co-authored-by: Fred Huang <60901360+fred-huang122@users.noreply.github.com> * Feature/kalman (#101) * Added extracted vision data with varying degrees of vanishing and noise * Attempt to store past raw game frames; starting work on test cases * added Andrew's filter * Integrated filters into position refiner * bad example test * Refined filter weights, added vision data for testing * Updated test data * Noise now added manually, updated test data * Amended test cases to address CI failure due to changes to PositionRefiner's constructor * Refinements to filters based on empirical data * Added some references for building tests * First pass unit tests * Some issues with unit tests. Working on fix * Added live testing utilities, conducted analytics for filters, refactored classes, added new datasets * Finalised analysis of filters, unit tests are working, added more live testing utilities * Deleted redundant files * Minor refinements to the live testing utilities * fixed formatting issues * Commented out utilities for testing and exporting data * Analysed vanishing problem, created sample datasets * Position refiner now has access to the last game frame and command map. Imputing feature is coming along , but there are unexplained spikes that are preventing it from working properly * Fixed issues, now imputes correctly based on last gameframe * Completed work on vanishing * Incorporated some suggestions from copilot regardign style * Addressed comments on PR * Removed redundant utility function * Factored out static method into global utility * cleanup * Added back error handling for imports when run from Jupyter * Renamed datasets to include the control mode, filtering only turned on during run mode together with vanishing * Fixed bug in tests due to renaming of files * Created working Kalman filter. Working on analytics * Working on analytics * Implemented a flag to add Gaussian noise in rsim. Added another more hackish implementation for comparison. * Analysing Kalman filter performance; need to merge new rsim utilities first * Cleaned up implementation, removed hackish alternative * Working on adding noise to each component independently * Completed implementation of noise addition * Addressed comments on PR, got orientation to work * Performed benchmarking on kalman filters * Performed benchmarking on kalman filters * More benchmarking * Kalman filter performance validated * Kalman filters now handle vanishing * Removed non-performing implementations * Rejigged analytics for Kalman filter * Addressed comments in PR, added vanishing, added support for ball * Minor linting * Merge branch 'feature/rsim_noise' into feature/kalman * Added filter for ball, added support for orientation * Now able to run analytics for orientation * Moved utility functions for adding Gaussian noise from classes representing balls/robots to the SSLStdenv class. Learned about this best practice in this week's lecture * Turned off a flag used for testing * Minor bug fix * Analysing data for orientation, plus some minor fixes * Completed work with Kalman filters, will now work on PR * Removed some redundant files * Renamed folder to ease merging with testing * Renamed folder to ease merging with testing * Cleanup, getting ready for PR * Small fix to satisfy linter * Final cleanup after reviewing PR diff * Improved filter docs * add docstring to math_utils.py * remove unused get_displacement_vector * remove unused import * [chore] formatting * chore: formatting * fix matrix inversion numerical instability and formatting of class name * remove improper static method use * improper use of tuple[float] type hint and mix bug referencing self.covariance_mat_xy instead of self.covariance_mat in KalmanFilterBall * removed references of .cmd_map not used position.py * fix test failure * Made non-global constant variable lower-cased * Using matrix transpose attribute instead of function call * update test cases * Removed redundant last_game_frame attribute * separate my and opp refiners * update running attribute for opposite refiner too * Minor formatting and naming changes to Kalman filter * fix incorrect assumption about robot id numbering in position refiner tests * corrected direct imputation of None values into vision data. Fix bug causing test fail * improve reset functionaity of position refiner * Fixed bugs introduced when removing assumption about numbering * fix dictionary logic in position refiner * update optional typing for KalmanFilterBall filter * fix typing in KalmanFilterBall * fix point cycle strat * Fixed issues in test due to filters no longer having ids, and now taking Robot instead of Dict[Int, Robot] * Kalman filter now has id attribute * label vision data using kalman id instead of last frame id * add comment about treating substitution as vanishing * remove unncessary imports * add authors --------- Co-authored-by: Fred Huang <fredhuang122106@gmail.com> Co-authored-by: Joel <nzmjoel@gmail.com> * chore(release): bump version to v1.7.0 * FIR filters (#81) * Added extracted vision data with varying degrees of vanishing and noise * Attempt to store past raw game frames; starting work on test cases * added Andrew's filter * Integrated filters into position refiner * bad example test * Refined filter weights, added vision data for testing * Updated test data * Noise now added manually, updated test data * Amended test cases to address CI failure due to changes to PositionRefiner's constructor * Refinements to filters based on empirical data * Added some references for building tests * First pass unit tests * Some issues with unit tests. Working on fix * Added live testing utilities, conducted analytics for filters, refactored classes, added new datasets * Finalised analysis of filters, unit tests are working, added more live testing utilities * Deleted redundant files * Minor refinements to the live testing utilities * fixed formatting issues * Commented out utilities for testing and exporting data * Addressed comments on PR * Removed redundant utility function * cleanup * Added back error handling for imports when run from Jupyter * Moved unused testing/debugging utilities to a separate text file, turned off filtering by default with a flag to PositionRefiner * Further cleanup * Removed all testing utilities, will create a testing branch * Cleaned up test suite * Removed data analysis * Removed data analysis * Removed data analysis * Final cleanup * revert position_refiner_integration_test * update test * fixes and formatting * remove unncessary comments * update readme --------- Co-authored-by: Fred Huang <fredhuang122106@gmail.com> Co-authored-by: Joel <nzmjoel@gmail.com> * chore(release): bump version to v1.8.0 * reverting mistake This reverts commit ba83a96. * planner.py naming convention fixes * addressed pull request comments * Updating * Updating * Updating * Updating * Updating * Added Field Bounds to FastPathPlannig * Added field bounds as an obstacle * Added boundaries are as obstacle, updated how the point of closesnt obstacle is calculated. * Added a project feature, to increase the speed * ignore DS_Store * optimise fastpathplanner --------- Co-authored-by: Jawad <jawad.olavian@gmail.com> Co-authored-by: wowthecoder <wengloo135@gmail.com> Co-authored-by: Sarthak Agarwal <sarth@Sarthaks-Macbook.local> Co-authored-by: Sarthak Agarwal <132744408+Vortex4627@users.noreply.github.com> Co-authored-by: Copilot <175728472+Copilot@users.noreply.github.com> Co-authored-by: maimaicircle <lynfevian@outlook.com> Co-authored-by: Fred Huang <fredhuang122106@gmail.com> Co-authored-by: Fred Huang <60901360+fred-huang122@users.noreply.github.com> Co-authored-by: Isaac Yong <72080621+isaac0804@users.noreply.github.com> Co-authored-by: Yangping Li <lynfe@LAPTOP-JJF6AK12.localdomain> Co-authored-by: Ningchaun <1311856651@qq.com> Co-authored-by: Copilot <198982749+Copilot@users.noreply.github.com> Co-authored-by: NingchuanIC <212761386+NingchuanIC@users.noreply.github.com> Co-authored-by: utama-release-manager[bot] <232491996+utama-release-manager[bot]@users.noreply.github.com> Co-authored-by: Joel <42647510+energy-in-joles@users.noreply.github.com> Co-authored-by: Sze Yoong Low <low.szeyoong@gmail.com> Co-authored-by: Sze Yoong Low <sy8low@gmail.com> Co-authored-by: Joel <nzmjoel@gmail.com>
Fix the defencer and goalkeeper, the goalkeeper won't go out of the block if the ball pass by the defencer, fix the defencer, will not go to block the shoot if it already block the path and it will not move if the attacker is not shooting rather than passing