Add utility module for collision detection#1222

AtsushiSakai wants to merge 1 commit intomasterAtsushiSakai/PythonRobotics:masterfrom

issue_1217AtsushiSakai/PythonRobotics:issue_1217Copy head branch name to clipboard