You might be interested in some codes that I wrote in the last years.
Don't hesitate to contact me if you have any problem with any of them.