Integrated and cleaned up code

Started writing functions to change the insert depth and the profile
number on the laser scanner programatically.