Added motor_zero function
Updated template soys for motor_zero