fix possible bugs in message.cpp -> arithmetic operation on void
try to add PID controller for tracking object mode.