veyron: Move code from rksdk to veyron, fix previous bug