ArduPilot Legacy (Atmega328)

Can you give us a hint as to what you're doing? At least a schematic or a sharp photo of your setup, and a link to the code.