I believe there are some good libraries out there for handling quaternions. Can't remember the topic but there was a discussion here within the last 10 days about their application to a similar problem.