pid dual loop control

Visitors: 515,863