Group Multi-Object Tracking for Dynamic Risk Map and Safe Path Planning