19 if(!_fb360c.servoCog) servo360_run();
20 int p = servo360_findServoIndex(pin);
23 if(state == 1 && _fs[p].feedback == 0)
46 _fs[p].speedTarget = 0;
47 _fs[p].angleError = 0;
51 _fs[p].derivativeV = 0;
57 _fs[p].angleCalc = _fs[p].angle;
63 _fs[p].derivative = 0;
75 servo360_setPositiveDirection(p, S360_CCW_POS);
77 _fs[p].theta = servo360_getTheta(p);
78 _fs[p].thetaP = _fs[p].theta;
79 _fs[p].angleFixed = _fs[p].theta;
81 _fs[p].pvOffset = _fs[p].angleFixed;
83 _fs[p].angle = (_fs[p].angleSign) * (_fs[p].angleFixed - _fs[p].pvOffset);
84 _fs[p].angleCalc = _fs[p].angle;
85 _fs[p].angleP = _fs[p].angle;
86 _fs[p].feedback = state;
92 _fs[p].feedback = state;
94 #ifdef _servo360_monitor_
95 _fs[p].csop = S360_MONITOR;