added some functions to iterate through the motion

need correct motion graph data
Fixed scaling cleaned up code

Root is now on at correct height.
code is cleaned up.
all that needs to be done is test the iterations though the graph with
current vertex when we have a good graph.
changes to solution
changes
 removed system_log.txt from repo