Created new directory for FullScale Prototype code

Modified lab model code in drive and sensor (FSPdrive and FSP sensor).
Need to add DAC code to drive.