update_v0.7: Added Control Function, still need PID and feedback
update_v0.7: Added Control Function, still need PID
update_v0.8: optimize code, stop logger
update_v0.8: optimize code 2
update_v0.8: update comments