The code you posted does something. You didn't describe what.
It has some expectations about hardware. You didn't describe yours.
You want the code to do something. You didn't describe what.
Instead, you trotted out the lame "it doesn't work". Well, fix it.