速度控制策略

将HX711读取的数据改成有符号的，然后将速度控制策略加上mass的影响，前半部分人工力场，后半部分摩擦减速