Adding navmesh code, which is more tested & fixed compared to jME3's base