Add new Servant-based test harness

- Add new test harness based on Servant
- Fix #31