Add a test on octree mesh collision.

test/CMakeLists.txt

test/fcl_resources/env.octree

test/test_fcl_octree.cpp

test/test_fcl_octree.py

test/test_fcl_utility.cpp

test/test_fcl_utility.h