added stairs
Merge pull request #6 from blazern/stairs

added stairs
Update sensor controls
remove debug lines
Updated sensor controls v2.0