This code refers to registers r40 and r41 in several places; I think those should be r30 and r31. There are also many typos in the comments in that source file. -- Jeremiah Willcock