Basic changes to file set up and added setup.m
Still need to fix writting problem