Trivial optimization using __restrict parameters

It gets about 0.006 seconds faster for each iteration.
Signed-off-by: Paulo Roberto Urio <jimmyskull@gmail.com>