feat: adds first draft of directional collision checker#1

MarcoMagriDev wants to merge 1 commit intohumbleMarcoMagriDev/moveit2:humblefrom

feat/directional_collision_checkerMarcoMagriDev/moveit2:feat/directional_collision_checkerCopy head branch name to clipboard