Example 2 In the sequence $\left\{a_{n}\right\}$,
$$
a_{1}=2, a_{n+1}=4 a_{n}-3 n+1\left(n \in \mathbf{N}_{+}\right) \text {. }
$$

Find the general term formula of the sequence $\left\{a_{n}\right\}$.