Added zero rad check in rotate function

This provides a speedup when rotation tracking is disabled or there's no rotation (highly unlikely).