Add TODO comment on bugs, add print function used for debug