Started work on getting encoder working along with respective encoder tests