Add fixes for TD3511 from Sebastian Michel

Signed-off-by: Stefan Schake <schake@embedded.rwth-aachen.de>