Add kraken implementations for all subsystems

[epshteinmatthew]

Coral, Algae, Elevator, Climber, all of them! this means add, not replace.

[epshteinmatthew]

joint angles and encoder config missing but everything else looks good

[epshteinmatthew]

done, now to test