added new windowing to control loop and got it working poorly, still does not compare to using past point