Added first steps into motion control from python script to gait control