Added a simple test bench

Change-Id: Iab6011197b8ddd542a764043b3ed6abd26a8d131