platoon mode now works. bSemMode==3 check inside bSemP may be redundant now