Added astyle for formating code, Hokuyo is done but still needs testing. Rename DataCollect Folder to Programs to make it more generallized