Add a reset program move function and fixed backlash issue with complex moves