Skip to content
Open
Show file tree
Hide file tree
Changes from 1 commit
Commits
File filter

Filter by extension

Filter by extension

Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
Next Next commit
WIP animations
  • Loading branch information
danic85 committed Apr 20, 2026
commit b2b2cc089ee02d274c26fa4fb4f43963ace411ac
68 changes: 31 additions & 37 deletions environments/cody.yml
Original file line number Diff line number Diff line change
Expand Up @@ -20,47 +20,46 @@ bus_servo:
enabled: true
config:
poses:
- legs_forward: {'leg_r_tilt': 2806, 'leg_r_hip': 1989, 'leg_r_knee': 1349, 'leg_r_ankle': 2754, 'neck_pan': 1698, 'neck_tilt': 118, 'leg_l_tilt': 1619, 'leg_l_hip': 1028, 'leg_l_knee': 2634, 'leg_l_ankle': 1567}
- sit: {'leg_r_tilt': 2806, 'leg_r_hip': 2063, 'leg_r_knee': 1840, 'leg_r_ankle': 3641, 'neck_pan': 1697, 'neck_tilt': 118, 'leg_l_tilt': 1621, 'leg_l_hip': 853, 'leg_l_knee': 2161, 'leg_l_ankle': 614}
- wave_1: {'leg_r_tilt': 2809, 'leg_r_hip': 2063, 'leg_r_knee': 1840, 'leg_r_ankle': 3641, 'neck_pan': 1697, 'neck_tilt': 118, 'leg_l_tilt': 1618, 'leg_l_hip': 855, 'leg_l_knee': 2614, 'leg_l_ankle': 1337}
- wave_2: {'leg_r_tilt': 2807, 'leg_r_hip': 2063, 'leg_r_knee': 1840, 'leg_r_ankle': 3641, 'neck_pan': 1697, 'neck_tilt': 118, 'leg_l_tilt': 1618, 'leg_l_hip': 855, 'leg_l_knee': 2614, 'leg_l_ankle': 874}
- stand_low: {'leg_r_tilt': 2790, 'leg_r_hip': 422, 'leg_r_knee': 717, 'leg_r_ankle': 3174, 'neck_pan': 1697, 'neck_tilt': 119, 'leg_l_tilt': 1578, 'leg_l_hip': 2668, 'leg_l_knee': 3342, 'leg_l_ankle': 1107}
- stand_high: {'leg_r_tilt': 2790, 'leg_r_hip': 692, 'leg_r_knee': 1322, 'leg_r_ankle': 2861, 'neck_pan': 1700, 'neck_tilt': 123, 'leg_l_tilt': 1578, 'leg_l_hip': 2510, 'leg_l_knee': 2712, 'leg_l_ankle': 1560}
- sit_edge: {'leg_r_tilt': 2790, 'leg_r_hip': 1918, 'leg_r_knee': 2768, 'leg_r_ankle': 2854, 'neck_pan': 1704, 'neck_tilt': 124, 'leg_l_tilt': 1577, 'leg_l_hip': 1183, 'leg_l_knee': 1332, 'leg_l_ankle': 1562}
- sit_edge_swing_l: {'leg_r_tilt': 2790, 'leg_r_hip': 1918, 'leg_r_knee': 2768, 'leg_r_ankle': 2854, 'neck_pan': 1704, 'neck_tilt': 124, 'leg_l_tilt': 1577, 'leg_l_hip': 1185, 'leg_l_knee': 1789, 'leg_l_ankle': 1988}
- sit_edge_swing_r: {'leg_r_tilt': 2790, 'leg_r_hip': 1918, 'leg_r_knee': 2222, 'leg_r_ankle': 2496, 'neck_pan': 1704, 'neck_tilt': 124, 'leg_l_tilt': 1577, 'leg_l_hip': 1182, 'leg_l_knee': 1345, 'leg_l_ankle': 1511}
- storage: {'leg_r_tilt': 2784, 'leg_r_hip': 1006, 'leg_r_knee': 772, 'leg_r_ankle': 2991, 'neck_pan': 1708, 'neck_tilt': 121, 'leg_l_tilt': 1601, 'leg_l_hip': 3108, 'leg_l_knee': 3258, 'leg_l_ankle': 1286}
- legs_forward: {'leg_r_tilt': 2784, 'leg_r_hip': 1005, 'leg_r_knee': 1998, 'leg_r_ankle': 2351, 'neck_pan': 1710, 'neck_tilt': 121, 'leg_l_tilt': 1606, 'leg_l_hip': 3099, 'leg_l_knee': 2107, 'leg_l_ankle': 1865}
- sit: {'leg_r_tilt': 2784, 'leg_r_hip': 866, 'leg_r_knee': 2042, 'leg_r_ankle': 3396, 'neck_pan': 1711, 'neck_tilt': 121, 'leg_l_tilt': 1597, 'leg_l_hip': 3229, 'leg_l_knee': 2095, 'leg_l_ankle': 698}
- wave_1: {'leg_r_tilt': 2785, 'leg_r_hip': 857, 'leg_r_knee': 2037, 'leg_r_ankle': 3396, 'neck_pan': 1710, 'neck_tilt': 121, 'leg_l_tilt': 1599, 'leg_l_hip': 3131, 'leg_l_knee': 2626, 'leg_l_ankle': 1371}
- wave_2: {'leg_r_tilt': 2785, 'leg_r_hip': 857, 'leg_r_knee': 2037, 'leg_r_ankle': 3396, 'neck_pan': 1710, 'neck_tilt': 121, 'leg_l_tilt': 1599, 'leg_l_hip': 3131, 'leg_l_knee': 2626, 'leg_l_ankle': 701}
- stand_straight: {'leg_r_tilt': 2735, 'leg_r_hip': 1968, 'leg_r_knee': 2029, 'leg_r_ankle': 2353, 'neck_pan': 1711, 'neck_tilt': 121, 'leg_l_tilt': 1596, 'leg_l_hip': 2087, 'leg_l_knee': 2075, 'leg_l_ankle': 1799}
- stand_low: {'leg_r_tilt': 2728, 'leg_r_hip': 2910, 'leg_r_knee': 593, 'leg_r_ankle': 2922, 'neck_pan': 1712, 'neck_tilt': 116, 'leg_l_tilt': 1604, 'leg_l_hip': 1374, 'leg_l_knee': 3477, 'leg_l_ankle': 1136}
- stand_high: {'leg_r_tilt': 2687, 'leg_r_hip': 2547, 'leg_r_knee': 1080, 'leg_r_ankle': 2753, 'neck_pan': 1711, 'neck_tilt': 116, 'leg_l_tilt': 1595, 'leg_l_hip': 1536, 'leg_l_knee': 2976, 'leg_l_ankle': 1522}
- sit_edge: {'leg_r_tilt': 2784, 'leg_r_hip': 985, 'leg_r_knee': 2897, 'leg_r_ankle': 2816, 'neck_pan': 1711, 'neck_tilt': 121, 'leg_l_tilt': 1606, 'leg_l_hip': 3072, 'leg_l_knee': 1431, 'leg_l_ankle': 1161}
- sit_edge_swing_l: {'leg_r_tilt': 2784, 'leg_r_hip': 985, 'leg_r_knee': 2897, 'leg_r_ankle': 2816, 'neck_pan': 1709, 'neck_tilt': 121, 'leg_l_tilt': 1606, 'leg_l_hip': 3071, 'leg_l_knee': 1928, 'leg_l_ankle': 1154}
- sit_edge_swing_r: {'leg_r_tilt': 2783, 'leg_r_hip': 986, 'leg_r_knee': 2028, 'leg_r_ankle': 2633, 'neck_pan': 1709, 'neck_tilt': 121, 'leg_l_tilt': 1606, 'leg_l_hip': 3072, 'leg_l_knee': 1326, 'leg_l_ankle': 1161}
- legs_straight_out: {'leg_r_tilt': 3696, 'leg_r_hip': 2066, 'leg_r_knee': 1904, 'leg_r_ankle': 2777, 'neck_pan': 1713, 'neck_tilt': 116, 'leg_l_tilt': 599, 'leg_l_hip': 2103, 'leg_l_knee': 2285, 'leg_l_ankle': 1140}
- crab: {'leg_r_tilt': 3695, 'leg_r_hip': 1046, 'leg_r_knee': 1451, 'leg_r_ankle': 2745, 'neck_pan': 1712, 'neck_tilt': 116, 'leg_l_tilt': 599, 'leg_l_hip': 2930, 'leg_l_knee': 2855, 'leg_l_ankle': 1230}
instances:
- name: "leg_r_tilt"
model: 'ST3215'
id: 1
range: [2511, 3944] # 1433 total range (4095 = 360 degrees)
range_degrees: 125.9
start: 2810
# calibrate_on_boot: true
range: [2352, 3749]
# start: 2791
- name: "leg_r_hip"
model: 'ST3215'
id: 3
range: [0, 2063]
range_degrees: 181.3
range: [615, 3423]
# center_on_boot: true
# calibrate_on_boot: true
# start: 1688
# start: 977
- name: "leg_r_knee"
model: 'ST3215'
id: 2
range: [717, 3297]
range_degrees: 226.2
# start: 1345
range: [626, 3384]
# start: 1999
- name: "leg_r_ankle"
model: 'ST3215'
id: 6
range: [2459, 3872]
range_degrees: 123.7
# start: 2762
range: [1123, 3638]
# start: 2351
- name: "neck_pan"
model: 'ST3215'
id: 12
range: [0, 3412] # 300 degrees = 3412, 360 degrees = 4095
range_degrees: 299.7
start: 1706
# calibrate_on_boot: true
# demonstrate_on_boot: true
Expand All @@ -69,7 +68,6 @@ bus_servo:
# baudrate: 115200
# id: 4
# range: [0, 1023]
# range_degrees: 300
# start: 511
# calibrate_on_boot: true
# demonstrate_on_boot: true
Expand All @@ -79,7 +77,6 @@ bus_servo:
baudrate: 115200
id: 11
range: [30, 220]
range_degrees: 55.6
start: 120
speed: 60 # max=0, 1 - 3000 tested
# acceleration: 0 # max (no significant difference between this and 1 - 3000)
Expand All @@ -97,27 +94,24 @@ bus_servo:
model: 'ST3215'
id: 7
range: [8, 1796] # 1788 total range (4095 = 360 degrees)
range_degrees: 156.9
start: 1617
# calibrate_on_boot: true
# start: 1607
- name: "leg_l_hip"
model: 'ST3215'
id: 8
range: [853, 3098]
range_degrees: 197.3
# start: 2451
range: [615, 3423]
# center_on_boot: true
# calibrate_on_boot: true
# start: 977
- name: "leg_l_knee"
model: 'ST3215'
id: 9
range: [1332, 3404]
range_degrees: 181.1
# start: 2643
range: [684, 3471]
# start: 2106
- name: "leg_l_ankle"
model: 'ST3215'
id: 10
range: [614, 2270]
range_degrees: 145.2
# start: 1566
range: [520, 3059]
# start: 1856
# demonstrate_on_boot: true

chatgpt:
Expand Down
6 changes: 4 additions & 2 deletions src/modules/actuators/bus_servo/bus_servo.py
Original file line number Diff line number Diff line change
Expand Up @@ -48,7 +48,7 @@ def __init__(self, **kwargs):
self.model = kwargs.get('model', 'ST')
self.index = kwargs.get('id')
self.range = kwargs.get('range')
self.range_degrees = kwargs.get('range_degrees', None) # Optional range in degrees for easier control
self.range_degrees = kwargs.get('range_degrees', self.calculate_range_degrees(self.range[0], self.range[1]))
self.start = kwargs.get('start') # Default start position
self.poses = kwargs.get('poses') # Dictionary of poses
self.baudrate = kwargs.get('baudrate', 1000000)
Expand Down Expand Up @@ -416,7 +416,7 @@ def calibrate_dynamic(self):
max_pos = pos
# Print on the same line, pad with spaces to clear previous content
# (4095 = 360 degrees, so 1264 = 111 degrees)
range_degrees = (360/4095)*(max_pos - min_pos) if min_pos is not None and max_pos is not None else 'N/A'
range_degrees = self.calculate_range_degrees(max_pos, min_pos)
print(f"\rCurrent position: {pos}, Min: {min_pos}, Max: {max_pos} Range(deg): {range_degrees}", end='', flush=True)
time.sleep(0.05)
if sys.stdin in select.select([sys.stdin], [], [], 0)[0]:
Expand All @@ -436,6 +436,8 @@ def calibrate_dynamic(self):
self.start = (min_pos + max_pos) // 2
self.log(f"Start position {self.start} out of new range, setting to midpoint {self.start}")

def calculate_range_degrees(self, max_pos, min_pos):
return (360/ST_MAX)*(max_pos - min_pos) if min_pos is not None and max_pos is not None else 'N/A'
def calibrate_to_center(self):
"""
Move the servo to the center of its range.
Expand Down
51 changes: 22 additions & 29 deletions src/modules/personality/personality.py
Original file line number Diff line number Diff line change
Expand Up @@ -34,11 +34,11 @@ def __init__(self, **kwargs):
self.imu = {} # Set in main.py
self.vision = None # Set in main.py
self.euler = None
self.balance_enabled = kwargs.get('balance_enabled', True)
self.balance_enabled = kwargs.get('balance_enabled', False)
self.chicken_head_enabled = kwargs.get('chicken_head_enabled', False)
self.track_people = kwargs.get('track_people', True) # Uses vision data to track detected people with the eyes, and optionally neck servos.
self.track_people = kwargs.get('track_people', False) # Uses vision data to track detected people with the eyes, and optionally neck servos.
self.track_people_servos = kwargs.get('track_people_servos', False) # Moves neck servos to track detected people.
self.one_leg_balance_enabled = kwargs.get('one_leg_balance_enabled', True)
self.one_leg_balance_enabled = kwargs.get('one_leg_balance_enabled', False)
self.servos = {} # Set in main.py
self.pose = None

Expand Down Expand Up @@ -215,34 +215,27 @@ def cycle_display(self):
self.publish('display/body/text', text=f"{self.pose}", font_size=20)

def loop_10(self):
# loop 3 times:
# for i in range(3):
# self.servos['leg_l_ankle'].move(1000, speed=0)
# self.servos['leg_l_ankle'].move(1500, speed=0)
# self.servos['leg_l_ankle'].move_degrees(50)
# self.scan_vision()
# self.output_current_pose()
# self.publish('servo/pose', pose_name='wave_1') # For testing pose movement
# time.sleep(1)
# current_pose = self.estimate_current_pose()
# if current_pose not in self.servos['leg_r_tilt'].poses:
# return
# if current_pose == 'sit':
# self.publish('servo/pose', pose_name='wave_1') # For testing pose movement
# self.publish('servo/pose', pose_name='wave_2') # For testing pose movement
# self.publish('servo/pose', pose_name='wave_1') # For testing pose movement
# self.publish('servo/pose', pose_name='wave_2') # For testing pose movement
# self.publish('servo/pose', pose_name='sit') # For testing pose movement
# self.pose = 'sit'
# elif current_pose == 'sit_edge':
# self.pose = 'sit_edge_swing_l'
# elif current_pose == 'sit_edge_swing_l':
# self.pose = 'sit_edge_swing_r'
# elif current_pose == 'sit_edge_swing_r':
# self.pose = 'sit_edge'
# elif current_pose == 'legs_forward':
# self.pose = 'sit'
# self.publish('servo/pose', pose_name=self.pose) # For testing pose movement
current_pose = self.estimate_current_pose()
if current_pose not in self.servos['leg_r_tilt'].poses:
self.publish('servo/pose', pose_name='legs_forward') # Start in a default pose
return
if current_pose == 'sit':
self.publish('servo/pose', pose_name='wave_1') # For testing pose movement
self.publish('servo/pose', pose_name='wave_2') # For testing pose movement
self.publish('servo/pose', pose_name='wave_1') # For testing pose movement
self.publish('servo/pose', pose_name='wave_2') # For testing pose movement
self.pose = 'sit'
elif current_pose == 'sit_edge':
self.pose = 'sit_edge_swing_l'
elif current_pose == 'sit_edge_swing_l':
self.pose = 'sit_edge_swing_r'
elif current_pose == 'sit_edge_swing_r':
self.pose = 'sit_edge'
elif current_pose == 'legs_forward':
self.pose = 'sit'
self.publish('servo/pose', pose_name=self.pose) # For testing pose movement
pass

def loop(self):
Expand Down
Loading