Added test motor function to test that motors run