You can find almost all functions you need in WPILib. To get started in code, read the tutorial (and the more detailed ones linked there).
For more on our GitHub organization and repositories (or Github in general https://docs.github.com/en) review those sections.
For an in-depth course on control theory and programming in FRC, read this book.