Modified the over written problem
Merge pull request #26 from qiqiapple/master

Modified the over written problem
Merge pull request #9 from RoboGroup3/master

Get Qi's code