Manipulator LQGMP implemented