https://doi.org/10.1016/j.ifacol.2015.06.355