graph fixes
ES: SITL
Merge pull request #29 from ahcorde/master

ES: SITL