riccati-equation code snippets in matlab