starting to change firmware code for our robot