Change more arrays to mat/cell and bug fix.
Start 1.8.1