code for locomotion on granular media using RFT - View it on GitHub