add-pidctrl-module-first-stage

Need further debug