Adding dolfin_assert where appropriate and using const for STL iterators. Fixed conflict in unit/test.py