Matlab & Naive C Implementation added