Fix 3D points cloud color exported by the SfM engine

Color was not added in the right order in the vec_color array.