Rasta actually did practically all the code for this, I just put it together… poorly :p
Edit: compile with -lcrypto flag.