PocketMatrix

Take a look at the PocketFrog source. There are some rotation functions in the rasterizers that you could use. I don't know how fast they are but you could try optimizing them if you need to.

Regards,
Chris

Yes I would suggest looking at PocketFrog's implementation.