Ported debug draw constraints modes
Added missing license headers and readme for github