19 if(!_fb360c.servoCog) servo360_run();
20 int p = servo360_findServoIndex(pin);
23 int delta = turns * S360_ENC_RES;
25 while(
lockset(_fb360c.lock360));
27 _fs[p].angle += delta;
28 _fs[p].angleP += delta;
29 _fs[p].angleFixed += delta;
30 _fs[p].angleFixedP += delta;
31 _fs[p].turns += turns;
34 if(_fs[p].csop == S360_POSITION)
37 _fs[p].angleTarget += delta;
40 else if(_fs[p].csop == S360_SPEED)
42 _fs[p].angleCalc += delta;
43 _fs[p].angleTarget += delta;
46 else if(_fs[p].csop == S360_GOTO)
48 _fs[p].angleTarget += delta;
50 _fs[p].angleCalc += delta;