added voxelization methods to MPMesh
dynamic scene now moves every update call
voxelized potential field planning kind of works