Merge pull request #1 from camilocarrillo/master

Friday morning Changes
Merge pull request #2 from camilocarrillo/master

plots working and code compiling
Merge pull request #3 from camilocarrillo/master

my time changes
Code cleaned and mpu read woriking, miloc, use this ONE!