Merge pull request #71 from shujingke/shujing

Shujing
Some improvements in planner.
Add representation of block colors