新增电机控制和传感器控制逻辑

新增电机控制和传感器控制逻辑