Update for 3-axis motor controller

Alpha version of 3-axis firmware