Somehow lost previous controller values. Corrected it.
Control_motion almost 100% ok. Logic needs debugging. Changed minimum threshold for logic to match motion.