Added preliminary F5xxx/6xxx support - developed on F5172, yet to test.