Updated PIDs for z control, shape matching.