Feature request

Is your feature request related to a problem? Please describe.
When we raise an internal error it may be quite some time before we get something in the dataflash log or in the mavlink stream. This makes it harder to correlate internal errors with codepaths.

Describe the solution you'd like
Emit a statustext and/or log message when we detect an internal error has

Hello, I'm master student. I'm interested in your nice lgsvl simulator!!

I have point cloud data of a city and from the point cloud data I want to make HD map. In addition, with your lgsvl simulator and autoware platform I will simulate autonomous driving .
Is it possible to do that things? I want you to tell me what kind of data and what procedure is needed to simulate automated driving in

void AStarExpansion::add(unsigned char* costs, float* potential, float prev_potential, int next_i, int end_x,  int end_y)
{
    .........
    if(costs[next_i]>=lethal_cost_ && !(unknown_ && costs[next_i]==costmap_2d::NO_INFORMATION))
        return;
    potential[next_i] = p_calc_->calculatePotential(potential, costs[next_i] + neutral_cost_, next_i, prev_potential);
     .......
}

Describe the Bug
Some of the Matlab API functions of the Supervisor return non-native Matlab array, e.g.:
https://github.com/cyberbotics/webots/blob/master/lib/controller/matlab/wb_supervisor_node_get_velocity.m#L6

Instead, their returned value should be converted to an array, e.g.:
https://github.com/cyberbotics/webots/blob/master/lib/controller/matlab/wb_supervisor_field_get_sf_vec3f.m