add new encoders' controller

LibSidServo/examples/goto.c

@@ -103,15 +103,19 @@ int main(int _U_ argc, char _U_ **argv){
     printf("Mount position: X=%g, Y=%g\n", RAD2DEG(M.X), RAD2DEG(M.Y));
     if(isnan(G.X) && isnan(G.Y)) goto out;
     double *xtag = NULL, *ytag = NULL, xr, yr;
+    double _7deg = RAD2DEG(7.);
     if(!isnan(G.X)){
         xr = DEG2RAD(G.X);
         if(G.relative) xr += M.X;
         xtag = &xr;
+        // set max speed
+        Mount.setSpeed(&_7deg, NULL);
     }
     if(!isnan(G.Y)){
         yr = DEG2RAD(G.Y);
         if(G.relative) yr += M.Y;
         ytag = &yr;
+        Mount.setSpeed(NULL, &_7deg);
     }
     printf("Moving to ");
     if(xtag) printf("X=%gdeg ", G.X);