Initial implementation of the Uzawa algorithm