start inserting objects every pass
add color setting function
properly inserting objects
object insertion working
Merge pull request #9 from mikeferguson/insert_objects

use shape primitives to represent all pieces in the planning scene