Setting entity state properly.
Fixed seg fault when receiving teleoperation maneuver.
Fixed invalid read by setting parent message manually.
Renamed a poorly named variable.