diff --git a/coco/src/fn_fuji/fuji_set_directory_position.c b/coco/src/fn_fuji/fuji_set_directory_position.c index ba4a2dd..fc4b9a3 100644 --- a/coco/src/fn_fuji/fuji_set_directory_position.c +++ b/coco/src/fn_fuji/fuji_set_directory_position.c @@ -6,6 +6,22 @@ bool fuji_set_directory_position(uint16_t pos) { - /* TODO, implement */ - return false; -} + struct _sdp + { + uint8_t opcode; + uint8_t cmd; + uint16_t pos; + } sdp; + + sdp.opcode = OP_FUJI; + sdp.cmd = FUJICMD_SET_DIRECTORY_POSITION; + sdp.pos = pos; + + bus_ready(); + + dwwrite((uint8_t *)&sdp, sizeof(sdp)); + if (fuji_get_error()) + return false; + + return true; +} \ No newline at end of file diff --git a/fujinet-fuji.h b/fujinet-fuji.h index 1d2e0a3..f7aeeac 100644 --- a/fujinet-fuji.h +++ b/fujinet-fuji.h @@ -7,6 +7,7 @@ #ifdef _CMOC_VERSION_ #include + #include #ifndef bool #define bool _FNBool