New Motor Controller Code - Changed Strategy