Further Optimizations

To add 1 for the right child, use a (very fast) "bitwise or" operation: