Added debug draw - not complete