Started SB6 example springmass
Fixed some issues with the springmass example