Cleaning up some debugging printf calls. Looks like I am on the right track now. Just going to start figuring out the rs, rt, rd, etc now.