Simulation when using Moveit with tm_driver doesn't move.

[JensVanhooydonck]

When using the moveit integration, the robot doesn't move in simulation.
When changing the funtion set_joint_states from

void TmRobotState::set_joint_states(const std::vector<double> &pos, const std::vector<double> &vel, const std::vector<double> &tor)
{
	joint_angle() = pos;
	joint_speed() = vel;
	joint_torque() = tor;
}

to

void TmRobotState::set_joint_states(const std::vector<double> &pos, const std::vector<double> &vel, const std::vector<double> &tor)
{
	for (size_t i = 0; i < 6; ++i) {
		tmRobotStateDataFromEthernet.joint_angle[i] = pos[i] * (180.0 / M_PI);
		tmRobotStateDataFromEthernet.joint_speed[i] = vel[i];
		tmRobotStateDataFromEthernet.joint_torque[i] = tor[i];
	}
	multiThreadCache.set_catch_data(tmRobotStateDataFromEthernet);
}

The simulation works again.