Simulating self made SLAM

edit

I have a basic SLAM system built and am hoping to test it in a simulator. I'm having trouble figuring out how to integrate my code into a simulation. I'm looking for a 2D simulation that's very basic. The stage simulator looks promising. Could somebody point me in the right direction? Thanks.