Proper multilinear interpolation for both value and gradient#6

jfisac wants to merge 2 commits intodynamic_plannerHJReachability/fastrack:dynamic_plannerfrom

jfisac/interpolatorHJReachability/fastrack:jfisac/interpolatorCopy head branch name to clipboard