Mavproxy classes put into separate file, so it's working finally. A Mode ros mesage managed to change the flight mode of a SITL simulated UAV.