Add basic (albeit not complete) mtpsr hwtest

Okay, this should be correct now.