Added code for upright motor testing