This implementation is derived from Toshio Fukushima's paper and Fortran code. http://dx.doi.org/10.1016/j.cam.2014.12.038