20130605_6

1. automated header control
2. 3d terrain mapping - realtime mode
3. autonomoud guidnace method