Motor Control Logic