Add unit tests for displacement accessible and also include
an assertion when adding a displacement value for a dof id.