Ardusub源码解析学习（六）—— althold model