Corrected many things, predominantly node-space / world-space transforms. Also documented and commented code. Consider this semi-working.