Stochastic approach in solving kinestatic equations for constrained robot control