Filter class and some updates

Adding Filter class, updated testing files, updated motor controller