Draw Path And Free Movement

Update 3 More free movement and correct draw path over an obstacle. Also added set linear draw path and curve for A to B point