forward algorithm code snippets in matlab