Added test code.
Hardware ready for final testing.