Add Scale Function, and significant progress on generating motion