Added Test Motor

First attempt to working with two motors