Add TODO tags
Move to right package
Add TODO tags
Fix Java Doc