1. Remove uncessary index calculation.
2. Use mad/mad24 as possible.
Signed-off-by: Yan Wang <yan.wang@linux.intel.com>